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ABSTRACT 



The calibration problem of a Short Baseline Underwater 
Vehicle Tracking Range is concerned largely with the coherency 
of path as the target vehicle passes from the domain of one 
array into that of another. The arrays are placed 
approximately in a hexagonal mesh. Thus there are regular 
locations (triple overlap regions) where the vehicle is 
tracked simultaneously by three separate arrays. Longbase 
methods can be used to locate the vehicle in these isolated 
regions. Presumably the four determinations (three for the 
individual short baseline arrays and one for the long 
baseline) can be used to locate the arrays and help calibrate 
the range. 

This thesis contains a feasibility study for this idea. 
Vehicles are placed at known locations in the triple overlap 
regions. A sequence of correction actions is postulated and 
the algorithms have been programmed. It appears to work quite 
well within the confines of this idealized study. 



iii 



C. 

THESIS DISCLAIMER 

The reader is cautioned that the computer programs developed 
in this research may not have been exercised for all cases of 
interest. While every effort has been made, within the time 
available, to ensure that the programs are free of computational 
and logic errors, they cannot be considered validated. Any 
application of these programs without additional verification is at 
the risk of the user. 
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I. INTRODUCTION 

The Naval Undersea Weapons Engineering Station (NUWES) 
currently operates nine test ranges for the purpose of testing 
and analyzing the performance of torpedoes. These ranges 
provide a three-dimensional track of torpedoes (or other water 
borne vehicles) from acoustic information received by bottom 
based sensor arrays. This thesis supports ongoing research 
conducted by Professor Robert R. Read of the U. S. Naval 
Postgraduate School, whose goal is to monitor the calibration 
of these ranges. 

The focus of this thesis is to support range calibration, 
specifically, by investigating sensor location error (position 
and orientation) using raw tracking data provided by the range 
itself. Since the sensors are inaccessible on the ocean 
floor, their exact locations are in doubt and estimated by a 
range survey procedure. The survey is costly and takes an 
entire day for a single sensor array, requiring that the range 
be shutdown, thus losing valuable testing time. This 
OPERATIONAL estimate of sensor location is subject to error 
and may differ from its ACTUAL location. Successive resurveys 
of sensor arrays find the array locations moved by as much as 
tens of feet. 

A difficulty in using the range, is that two or more 
versions of a torpedo track can be provided by adjacent 
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sensing arrays. These differing versions of track manifest 
themselves as the torpedo traverses areas of mutual sensor 
monitoring (overlap regions) . Accurate study of torpedo 
performance becomes difficult when considering the joint 
behavior of several vehicles (e.g. a submarine and torpedo). 

The calibration support methodology developed in this 
paper will focus on treating the location of those sensing 
arrays that are interior to the others (see Figure 3) . The 
results will be a set of decision rules for the iterative 
correction of the interior sensors location. Appendix I 
contains a mathematical formulation of the problem and 
explains the choice of algorithm made. In the context 
presented here, this methodology works quite well. 

The organization of the thesis is as follows: 

Chapter II contains explicit background of the range setup and 
operation along with a description of locational errors. 
Chapter III contains the error correction methodology 
developed to solve for sensor locational errors. Specific 
assumptions are included here for this problem. Chapter IV 
integrates other sensors into the correction methodology and 
relaxes the initial assumption made in the solution 
formulation. Chapter V reports on the conclusions reached and 
recommendations for further work in this area. 
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II 



BACKGROUND 



A. RANGE CONSTRUCTION AND OPERATION 

References 1-6 outline previous work done in support of 
this project. This thesis, as with previous works, will 
utilize data from the Nanoose range. 

The Nanoose underwater tracking range consists of a number 
of sensing arrays of the short baseline (SBL) type positioned 
on the ocean bottom. Each array is three dimensional and 
contains four hydrophones (see Figure 1) . 



SCHEMATIC DIAGRAM OF 3-D 
SENSOR ARRAY 




Figure l. SBL Sensor Array. 
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The acoustic center is the geometric center of the box formed 
by the arms of the sensor array and is used as the sensor 
array's location. The 30 foot sensor arms are short in 
comparison to the target tracking distances, thus the name 
"short baseline" (SBL) . 

Targets on the range are tracked in the following manner. 
The targets (e.g. torpedoes) are fitted with acoustic 
transmitters (pingers) which emit sound pulses at precisely 
timed intervals. The pingers and sensor arrays, are 
synchronized with the shore based clock. When an array 
detects an acoustic pulse, the transit times of the sound 
wave, from the target to the sensor array, are computed. 

A unique relative target position location (posloc) is 
found using the transit times measured from the target pinger 
to the four sensor hydrophones. The individual sound pulses 
are coded for the purpose of distinguishability . Figure 2 
shows a sensor array interacting with various target vehicles. 

A technique known as ray tracing is used to determine 
location. A ray is the normal to the acoustic wave front. 
Based on Snell's Law [Ref. 7], ray tracing reconstructs the ray 
path traveled by sound in water. The differential of pulse 
arrival times at the four hydrophones are used to construct 
the ray's azimuth and elevation angles at the array's 
location. These are used to initialize the ray tracing 
algorithm. The computation works its way back to the sound 
source and the algorithm is stopped when the transit time is 
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'used up'. The result is a posloc for the target at the time 
of the ping. 

Reconstruction of the target local track is accomplished 
by joining the SBL poslocs of each array over time. This 
produces a relative or apparent target track from each sensor. 
Connecting these relative tracks gives a target track 
throughout the range. The use of many sensor arrays (Figure 
3) , enables continuous monitoring of the entire range. Each 
array monitors a finite volume of water, limited by both 
acoustical attenuation and time gating. Careful arrangement 
of the sensor arrays enables full coverage without excessively 
sized overlap regions. These overlap regions are necessary to 
ensure track continuity throughout the range. 

There are two types of overlap regions, double and triple. 
The names correspond to the numbers of arrays which serve 
each, two or three respectively. An example of a torpedo 
traversing a double overlap region is presented in Figure 4. 
This shows an ideally continuous, or coherently connected, 
track as the torpedo crosses from one sensor region to 
another . 

B . POSLOC ERRORS 

The track versions generated by the individual sensors are 
rarely connected as the target crosses these overlap regions. 
Separations in track are commonly on the order of 40-50 feet 
(slant range) . 
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SENSOR ARRAY CROSSOVER REGIONS 




NOT tracked 

— - SINGLE COVERAGE 

— DOUBLE COVERAGE 



Figure 4. Torpedo Track Through a Double Overlap Region 
(no sensor displacement errors) . 



The causes of these discontinuities can be grouped into 3 
general categories: 

1) Water Condition Errors/Ray tracing 

Reference 1 contains an analysis of this problem. 

2) Ringer Timing Errors (Offset and Synchronization) 

Reference 2 details work done in this area. 

3) Sensor Location Errors (Position and Orientation) 

References 3-6 contain previous work done in this 

area. This thesis continues this work. 

Examination of the current ray tracing initialization 
method, shows that it can contribute up to 1/3 of the total 
target positional errors. A recommended method of 
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initialization presented in Appendix F, reference 1, 
significantly reduces the errors caused by the current ray 
trace initialization method. 

The remaining significant errors are believed to be 
attributed to water column and sensor locational errors. In 
the water column, two effects come into play. First, the 
horizontal non homogeneity of the water causes the ray paths 
to become kinked. The second effect is the limited depth to 
which the depth velocity profile (DVP) is measured. The range 
obtains but one DVP measurement per day (due to cost and 
equipment constraints) and to a depth generally shallower than 
the deeper sensor hydrophones. Extrapolation of the DVP is 
required if a sensor hydrophone is deeper than the level 
provided by the measured profile. Uncorrected for, these 
effects can cause large posloc displacements. 

The location errors of the sensors lend themselves to 
relatively simple analyses and are discussed below. 

A number of other systematic error sources are present 
(e.g. bottom currents, curvature of the earth) , but their 
effects are of much smaller magnitude. For the present they 
are ignored. 

C. LOCATIONAL ERRORS 

A sensor location comprises six components. These are 
the X, y, and z position of the sensors acoustic center (in 
the range coordinate system) , and the xtilt, ytilt, and zrot 
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angular orientation of each array axis from the range 
coordinate axis. The tilt angles are measured to the sensor's 
arms from the horizontal. The zrot component measures the CCW 
rotation of the sensor from east (zrot=0 implies the x-arm is 
pointed east) . The xtilt, ytilt and zrot can be thought of in 
terms of roll, pitch and yaw , respectively. The x, y, z, and 
zrot terms are measured during the sensor survey. Such a 
survey locates the acoustical center of the array with respect 
to the range coordinate system. When this is combined with 
the tilt angles obtained from the sensor's x and y arms the 
array's OPERATIONAL location is determined. 

The following terms are defined: 

- OPERATIONAL location - the position and orientation of 
the sensor array as determined by survey techniques. 

- ACTUAL location - the true position and orientation of 
the sensor array. 

Surveyed positions will suffer from the category 1 errors, 
water column nonhomogeneity and ray tracing. Another possible 
cause for the deviations from previous OPERATIONAL locations 
(survey to survey) can be due to physical array shifts on the 
ocean floor. If such shifts actually do occur, previous 
locational data is invalidated. Thus range monitoring must be 
performed continuously. 

The last two components of the sensors location, xtilt and 
ytilt, can differ from the ACTUAL tilts due to inaccuracies of 
the indicators in the arms of the sensors. 
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It is easy to visualize in the two dimensional case the 
effect on the posloc from errors in the six components of the 
sensor location. A situation similar to that depicted in 
Figure 5 occurs if we confine the location errors to just x, 
y and rotational offsets. This is attributed to a shift in 
the local coordinate system of the sensor from which the 
poslocs are found. Posloc errors are less direct for errors 
in the z direction. Not only is there a change in the depth 
of the local coordinate system, but also in the water 
environment. As the sensor is 'displaced' in depth, the sound 
velocity at the new level of the hydrophones will be 



SENSOR ARRAY CROSSOVER REGION WITH SHIFTED SENSORS 




TRUE TORPEDO TRACK 

TORPEDO TRACK AS SEEN FROM A's RELATIVE POSmON 

TORPEDO TRACK AS SEEN FROM B'« RELATIVE POSfTION 

+ TRUE POSITION OF SENSORS A •nd B 
^ ASSUMED or RELATIVE POSITION ol SENSORS 



Figure 5. True and observed Torpedo Track as seen by 

displaced sensors. 
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different. This changes the ray paths of the sound pulses and 
causes a disproportional change in the target posloc direction 
vector. 

For an example of the size of the errors produced from 
deviations in the six locational components, consider a 0.5° 
tilt error (xtilt or ytilt) . This will cause a SBL posloc 
displacement of 40 feet at a 4000 foot range. This is a 
typical value of interest in an overlap region. 
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III. METHODOLOGY 



The adjustments to the OPERATIONAL location of SBL sensing 
arrays, will be first to the interior arrays. Interior arrays 
are those sensor arrays which have triple overlap with six 
adjacent, or satellite, sensor arrays (see Figure 3) . 

A. ERROR ANALYSIS 

Figure 6 contains a schematic diagram depicting the triple 
overlap regions which provide information to the interior 
array, A triple overlap region (henceforth referred to as a 
region) , represents a volume of water monitored, or served, by 
three independent sensor arrays; in the present case the 
specified interior array and two satellite arrays. Three 
independent poslocs will be generated for a given acoustic 
'ping'. In actuality these three poslocs will rarely be 
coincident. Their determination will be influenced by the 
error sources mentioned previously. 

1. Consensus Location (LONGBASE) 

The SBL poslocs are evaluated upon comparison with a 
consensus location. The choices for this location are one, or 
both of the other satellite poslocs, or some aggregate 
location of the three individual poslocs. Professor Read 
developed an algorithm which, assuming that the sensor arrays 
that service a region are positionally correct (x, y, and z) , 
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adjusts the azimuth and elevation angles (associated with each 
of the three arrays) so that the three poslocs coincide [Ref. 
3]. This method, long baseline (LBL) , uses the transit time 
information from the C- hydrophones of the three sensor arrays 
in a region. In this way a 'new coordinate' system from these 
hydrophones is formed. Since the 'arms' of this newly formed 
surrogate array are long in comparison to the distance to the 
target, this is termed "long baseline". 

Initially the transit times from each array are converted 
into the three SBL poslocs, which are not coincident. Each 
posloc falls on the surface of a 'sphere' described by varying 
the azimuth and elevation angles for a fixed transit time. 
Each of the three arrays produces this 'spherical' surface and 
they intersect at a single point. This point may be located 
either upward or downward in depth, and perhaps at a different 
angular location than the SBL poslocs. 

Since no sensor positional errors are assumed in longbase, 
a problem develops in that the depth of the LBL posloc may be 
'forced' from the averaged depth of the SBL poslocs. This may 
or may not move it closer to the true depth. As the longbase 
algorithm determines the depth of this consensus point, the 
horizontal position is also, updated to maintain constant 
transit times. This program is the main tool exploited in our 
developments. The exploitation of this program will be 
described subsequently. 
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2. Consistency Of Errors 

A formulation of the problem and reasons for the choice of 
a coordinate descent algorithm are found in Appendix I. Once 
a consensus location for the target is found (LBL posloc ) , an 
error table can be made for the specified interior array. 
This table will consist of the differences between the LBL and 
SBL poslocs and contains the following locational attributes: 
elevation angle, azimuth angle, horizontal range, x, y, and z 
coordinates. Note that redundant information is supplied. 
The azimuth, elevation angles and horizontal range, can be 
converted to x, y and z coordinates. 

To describe the exploitation of the LBL algorithm, 
consider an interior array which contains six regions. 
Suppose that the OPERATIONAL and ACTUAL location of the six 
satellite arrays are the same, but not so for the interior 
array. Then the poslocs produced by longbase will provide 
information about the location of the interior array. (It has 
been verified that for three coincident poslocs, the LBL 
posloc generated will fall on that coincident point.) 

Figure 7 illustrates an interior array and two of its 
regions along with the LBL and SBL poslocs in two dimensions. 
Expanded views of the two regions are shown in the wings. One 
can perceive a correction to the right and upwards. Next 
consider six satellite regions. One can imagine a consistency 
in the offset and rotational nature of the x and y errors. 
Heuristically , the optimal location for the interior array can 
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Triple Overlap Regions. 
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be found by correcting one 'error' at a time. 



B. ASSUMPTIONS 

The following assumptions are made in order to develop a 
prioritized set of corrections for the selected interior 
sensing array. 

1) SATELLITE SENSORS ARE ERROR FREE 

This assumption will allow full concentration on the 
posloc errors produced by the center array, without 
interference from noise in the locations of the satellite 
arrays . 

2) HOMOGENEOUS ISOSPEED WATER COLUMN (DVP) 

The advantage to making this assumption is that of 
simplification and the elimination of the errors produced in 
generating the SBL poslocs using the current algorithms. This 
simplifies the development of the error correction priorities. 
Posloc positional errors are now isolated to sensor array 
locational errors. 

C. TERMINOLOGY 

The following terminology is used throughout the paper and 
in the FORTRAN programs. 

For sensor number k, and overlap region j ( j=l to 6) : 

{X^;} position of the acoustic center of sensor 

array k, for i=l-3 (x, y, and z) in the Range 
coordinates (depth positive downward) 
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{Ki} 


angular orientation of sensor array k for i= 
1-3 (xtilt, ytilt, and zrot) . xtilt and ytilt 
measured from the horizontal, zrot measured 
CCW from the Range centerline 


{ERROR^j} 


induced (known) locational error to sensor 
array k, for i=l-6 (x, y, z, xtilt, ytilt, and 
zrot) 


{SHIFT,,;} 


corrections made to sensor array k's location 
for i=l-6 (X, y, z, xtilt, ytilt, and zrot) 




acoustic ping transit time from the target to 
sensor k's hydrophones i=l-4 (x, y, z, and c) 
in region j 




SBL posloc position for sensor k in region j 
for i=l-3 (x, y, and z) in the Range 
coordinates 


{XL,.3,i} 


LBL posloc position for sensor k in region j 
for i=l-3 (x, y, and z) in the Range 
coordinates 


{PHS,j> 


azimuth angle (CCW from east) to sensor k's 
SBL posloc in region j from the c hydrophone 




azimuth angle (CCW from east) to sensor k's 
LBL posloc in region j from the c hydrophone 


{THS,,^} 


elevation angle, from horizontal, to 

sensor k's SBL posloc in region j from the c 

hydrophone 


{THL,j} 


elevation angle, from horizontal, to sensor 
k's LBL posloc in region j from the c 
hydrophone 




horizontal range from sensor k's c hydrophone 
to region j's SBL posloc 




horizontal range from sensor k's c hydrophone 
to region j's LBL posloc 


Utilizing the 


above definitions, we have for sensor array k: 
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ACTUAL LOCATION: {X^ , j X^ j A^ , A^^ ^^.3} 

OPERATIONAL LOCATION :{ (Xi-i+ERROR^i) (X^j+ERRORk-j) (Xj._ 3 +ERRORt, 3 ) 

(A^ ,+ERR0R^4)’ (^^ j+ERRORi-s) (A^3+ERROR^s) } 

Solving for {SHIFT^;}, the ACTUAL location of the sensor array 

will be obtained as such: 

Xki = (Xki+ERROR^,) + SHIFTk, 

Xk2 = (X^'2+ERR0R^2) + SHIFTk ’2 

Xk3 = (Xk’3+ERROR^’3) + SHIFTi.'3 

Aki = (A^'i+ERROR^J + SHIFTi,4 
Ak2 = (Ak^+ERRORi-'s) + SHIFTi^’s 
Ki = (Ak’s+ERROR^Ift) + SHIFTi-’ft 

D. SETUP OF TEST CONDITIONS (SIMSTRT, SETUP) 

First values of the {ERROR^j} vector defined above are 
prescribed for each sensor array )c, in order to generate the 
OPERATIONAL locations. Next the DVP to be used is selected. 
This DVP will be 4880 ft/sec and extend to a depth exceeding 
the deepest hydrophone in order to eliminate the need for DVP 
extrapolation. The starting points for our 'pseudo target' 
are arbitrarily chosen to be in the center of each triple 
overlap region j, at a depth of 400 ft. The transit times 
{TIME|;j j}, i=l-4 , of acoustic pings are then generated from 

these starting points to the ACTUAL array locations. The are 
times derived using the RAYFIT program [Ref. 1], are analogous 
to the times provided by the range. 

With the transit times and' the OPERATIONAL location of the 
sensor arrays, SBL poslocs are generated through ray tracing. 
These SBL poslocs are the sensors perceived target position. 
The three poslocs in each region are then used to generate the 
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LBL poslocs. An error table for each sensor array is then 
formed using the LBL and SBL poslocs. This table contains the 
following LBL-SBL posloc difference information for sensor k 
and region j : 



THER^j 
PHER^’j 
HER. : ’ 

XER^'j 

zer,. 



= THL^j - THS 
= PHL^j - PHS 
= - HS 

= XL.;! - XS 
= XLi,’j’2 - XS 



kj' 
kj' 
kj' 
k,j,l ' 
k,j.2 ! 



elevation angle differences 
azimuth angle differences 
horizontal range differences 
X coordinate differences 
y coordinate differences 
coordinate (depth) differences. 



E. ERROR FIXING (ERRFIX) 

1. Measure of Error 

The goal is to minimize separation between the LBL 
poslocs and the interior arrays SBL poslocs in each region. 
A measure of error to gauge success is the three dimensional 
distance between the two poslocs: 

d = sjxER-+YER^^ZER'^ . 

Instead of this we will use an approximate equivalent measure 
developed by Professor Read in reference 1: 

d = \/ZER^+HER^+ (HLxPHER) ^ . 

This measure of error contains the horizontal separation 
distance (HER^ = XER^ + YER^) , and an additional term to 
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account for azimuthal errors. It's use circumvents the need 



for transforming spherical coordinates to cartesian 
coordinates . 

The total measure of error for a sensor array, will be the 
above measure averaged over the sensor's regions. 

2. Individual Error Corrections 

Error corrections can be thought of in four distinct 
phases: Azimuth, Depth (Z) by Elevation Angle, Tilt Angles 
(xtilt and ytilt) , and coordinates (X, Y, and Z) . This 
section examines individual locational error corrections. 
These individual error components are treated in isolation of 
the other locational errors that may exist for the sensor 
array. The next section will look at how to combine these 
error correction components into a integrated correction 
scheme to solve for array location. 

The component error corrections will be based on the 
average value of the individual errors of interest. The use 
of averaged error allows the optimal sensor location to be 
approached without excessive correction overshoot. 

Although an isospeed DVP is used, the algorithms will 
be written generally so as to facilitate the transition into 
a gradient environment. A correction scheme for each error 
independent of the others will be looked at first. A method 
to combine these into a correction algorithm will then be 
introduced . 
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a . Azimuth Errors 



An azimuth error (rotational error) , of the 
interior array will manifest itself in each region regardless 
of the water environment. Due to the ranges to the triple 
overlap regions, small azimuth errors will cause large posloc 
separations. Since these errors are easy to spot and their 
correction greatly minimizes posloc separation, an attempt 
will be made to correct these first. 

The errors due to azimuth will be of similar 
magnitudes in each region, but most importantly, of the same 
(consistent) sign. The magnitude of these errors in each 
region can be masked by even moderate x and y coordinate 
displacements of the interior sensor. In correcting for this 
azimuth error the average azimuth error over the regions is 
used as an initial guess. This first guess will generally be 
smaller in magnitude than the true azimuth error. 
b. Depth by Elevation Angle 

Once again consistency in the signs of the 
elevation angles is sought. Elevation angles of the same sign 
can be caused by a depth error to the interior array. As 
above for the azimuth errors, a depth correction can be made 
if the elevation angles possess the same sign. The magnitude 
of the correction will again be based on the average of the 
depth errors. Correction of this angular error using depth, 
vice a function of the elevation angles was chosen for 
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simplicity. Correcting for depth errors in this way also has 
the coincident benefit of correcting for elevation angle 
errors . 

In the isospeed environment, longbase is biased 
toward the error free (correct) satellite poslocs. A depth 
error to the interior array also correlates directly to a 
depth shift in its SBL posloc. This results because the SBL 
posloc direction vector is not effected by the depth change in 
the isospeed environment. Thus a positive, consistent, 
elevation error is induced by an OPERATIONAL depth that is 
deeper than ACTUAL. 

Transitioning to a gradient environment, longbase 
still remains biased toward the 'correct' poslocs. A depth 
error to the interior sensor now displays the following 
effect. As the sensor is moved deeper, the sound velocity of 
water will generally increase. This causes the elevation 
angles from each hydrophone to decrease when adjusted to the 
SBL posloc. This change in elevation angles, with respect to 
depth, will also be seen in the LBL poslocs for the same 
reason. Consistency will still be present even with this 
relationship between the elevation angles and depth, 
c. Tilt Angles 

The tilt errors, xtilt and ytilt, can be 
visualized as the orientation of the plane containing the X, 
Y, and C hydrophones. This plane will be defined by xtilt and 
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ytilt angles from an origin centered at the C-hydrophone . In 
the presence of no other errors, the SBL poslocs will be at 
"truth” for the ACTUAL values of the tilts. It is in this 
manner that the correction will be made. By constructing two 
planes, one locating the SBL poslocs (erroneous) and the other 
locating the LBL poslocs ("truth"), the difference in plane 
tilts can be found. This difference is the correction to the 
OPERATIONAL xtilt and ytilt. For convenience, the regions 
closest to 0° and 90° (in the range coordinate system) are 
chosen, although any two non collinear combination regions 
will work. 

d. X, Y, and Z Coordinate Errors 

These three positional errors will be determined 
in an identical manner. Any of these coordinate errors will 
manifest itself in each region consistently, although not 
necessarily proportionally (see section 2b: Depth by Elevation 
Angle, for a summary of the unique depth effects) . Errors 
from the comparison of LBL to SBL posloc positions, averaged 
over all regions will be used as a first guess correction to 
these coordinate errors. Since the effect of small angular 
errors produces large positional posloc errors, a fraction of 
this average error is used in order to guard against 
overshoot . 
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3. Integration of Error Corrections 



The above individual error corrections schemes are 
listed in the order of importance to the error fixing (ERRFIX) 
algorithm. The approach chosen will correct for angular 
errors first, followed by positional errors. This choice is 
made due to the large displacement effect caused by the 
angular errors at the distances of interest. 

The location corrections are preformed in an iterative 
fashion, correcting for one component error at a time. The 
new location of the array is evaluated after each correction, 
before proceeding on to the next correction. This allows for 
a controlled approach to the ACTUAL array location. 

Figure 8 outlines the ERRFIX algorithm and figure 9 
the detailed flow diagrams for the specified components. The 
tilt correction component of the first six error correction 
schemes, has a restriction placed on it. This restriction 
denies entry if no other previous corrections have been made. 
This minimizes the possibility of unnecessary cycling and 
invalid corrections to sensor location. The adjusted (SHIFT) 
tilt angles were found to move away from the ACTUAL tilt 
angles, in repeated back-to-back executions of the tilt 
correction component. 

The tuning constant to the positional corrections is 
introduced prior to the individual rectangular coordinate 
corrections. Since the angular errors have not been totally 
adjusted as yet, the posloc positional errors contain 
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ERRFIX FLOW CHART 



START 




Figure 8. ERRFIX Logic Flow Chart. 
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Figure 9. ERRFIX Individual Component Logic Flow Chart. 
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influences both from the angular and positional sensor 
locational errors. The adjustment of the positional errors 
using but a fraction of the average error causes the optimal, 
or ACTUAL, location to be approached more slowly. This is 
desirable in early iterations. As the number of passes 
through ERRFIX increases, the tuning constant is increased to 
speed convergence of the algorithm. As the ACTUAL location is 
approached, and the posloc errors reduced in magnitude, a 
fairly constant correction rate is then maintained. To limit 
this weighting scheme, so as not to overshoot the ACTUAL 
location, a ceiling of 3 for the tuning constant is imposed 
after 15 passes. The selection of these number was based on 
a minimal sensitivity analysis so efficiency is not expected. 

Unrestricted position correction (x, y, and z) is 
allowed after all the consistent errors are removed. These 
correction schemes still use averaged posloc errors and the 
tuning constant in the computation of the SHIFT vector. 

Exit criteria for ERRFIX is based on the number of 
passes made and the number of nonprof itable attempts to 
correct the sensor's location. The algorithm is exited after 
either 60 passes through ERRFIX, or 5 non improving attempts 
to correct location are made. Additional reasons (other than 
to prevent infinite cycling) , for these exit criteria are 
presented in chapter IV. 
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F. LOCATION OPTIMIZATION (ANNEAL) 

Since ERRFIX is a heuristic, an optimal solution is not 
guaranteed. A simulated annealing (ANNEAL) algorithm is then 
employed to further minimize the objective function. The 
basis for this algorithm is outlined in reference 8. The 
random number generator that is required came from the IMSL 
Library of Mathematical and Statistical functions [Ref. 9]. 
This library is developed for IBM PC computers and compiled in 
machine language and not reproducible here. Figure 10 
displays ANNEAL 's logic structure. 

As ANNEAL is executed with the current solution (SHIFT) 
near the ACTUAL, a small step size to be applied to SHIFT is 
used. This small step size, while increasing run time, also 
helps to prevent overshoot of the optimal location. The 
numbers chosen to size the steps are based upon limited 
sensitivity analysis conducted on the objective function in 
the vicinity of the minimum. The validation check for the 
proposed step is to insure that the new angular values are 
within bounds (xtilt, ytilt; -tt/2 to tt/2, and zrot; -n to n) . 

The 'cooling schedule' for the algorithm, which determines 
the probability of accepting a nonimproving step, is outlined 
in reference 8. A limited sensitivity analysis was performed 
to determine the parameters used in the calculation of the 
probabilities, and so efficiency may not be achieved. 
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ANNEAL FLOW CHART 




Figure 10. ANNEAL Logic Flow Chart. 
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Termination for the ANNEAL algorithm is two fold. Either 



30 bad 
function 



(nonimproving) steps accepted, or the 
within epsilon (lO"^) of zero, will cause 



objective 

exiting. 
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IV. RANGE INTEGRATION (CONTROL) 



Having the ability to correct for errors in an 'isolated' 
interior array (one with error free satellites) , we turn to 
the problem of correcting several arrays. In order to 
accomplish this goal, the first assumption made, the interior 
array's satellites are error free, needs to be removed. To do 
this, an interior array will be chosen for correction, in 
which all of its satellite arrays are closer to their ACTUAL 
location than this interior one. The objective function 
presented on chapter III will be utilized to determine the 
array of interest. By choosing the array with the maximum 
objective function value (either range global, or with respect 
to its satellites) , all of the satellite arrays are expected 
to require smaller locational adjustments. 

A. CONTROL 

The FORTRAN program, CONTROL, is set up to accomplish this 
range wide integration. Two problems arise when multiple 
arrays possess locational errors. First, in trying to achieve 
locational optimality for the array of interest, locational 
errors from the satellite arrays will prevent the objective 
function from reaching a zero value. Second, the sensing 
arrays that are selected for correction based on the objective 
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function value, may not be interior sensors (fewer than six 
triple overlap regions, e.g. array 24 of Figure 3). 

In the first problem, it was found that an iterative 
procedure was necessary to correct for multiple array location 
errors. Thus in ERRFIX, the restrictions on the number of 
passes and the number of 'bad' steps, was introduced (in 
addition to preventing infinite cycling) . This allows for 
location improvement without over-improving towards possible 
erroneous LBL poslocs. After the array of interest exits from 
ERRFIX, the entire range is re-examined to find the new worst 
array, and the process repeated. Since correction is in a 
step wise fashion, entrance into ANNEAL is delayed until all 
arrays are 'close' to their ACTUAL locations. The logic flow 
chart for CONTROL is displayed Figure 11. 

The other downside to 'all' the range arrays possessing 
locational errors, is that there will be no anchoring point 
for range location. The array locations will be optimized 
with respect to each other, but not with respect to any fixed 
outside point. The target tracks will then coincide in the 
overlap regions, but may not be the true track; only a 
relative track. 

It was noted that arrays with induced locational errors 
produced objective function values significantly larger than 
the error free arrays. An attempt was made to take advantage 
of this trend. In singling out those arrays with the larger 
than average objective function values, the correction 
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CONTROL FLOW CHART 




Figure 11. CONTROL Logic Flow Chart. 
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methodology could be selectively controlled. This decision 
rule has the advantage of reducing computer run time by 
eliminating the 'error free' arrays from the iteration 
scheme. The values of the control parameters were chosen 
arbitrarily. 

The second problem addressed, involvement of arrays with 
fewer than six overlap regions, could not be studied fully due 
to time constraints. The problems that occur here can be seen 
by a study of array number 24. This array has its overlap 
regions all located on one side. This will cause the ERRFIX 
algorithm to induce invalid depth corrections caused by tilt 
errors. Any tilt errors that happen to displace all the SBL 
poslocs upward (negative elevation angle errors) , will be seen 
as a depth error in the Depth by Elevation Angle component of 
ERRFIX. This effect will cause multiple optima to exist for 
these sensors without a full complement of regions. 
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V 



RESULTS 



A. ERROR FREE SATELLITES/ ISOSPEED DVP 

In this ideal situation, sensor array 15 was chosen as the 
test case. A random location ERROR was then applied to the 
array location. The initial location chosen (ACTUAL) , is the 
location currently defined by the Nanoose range. Application 
of the ERROR vector to this ACTUAL location generated our 
OPERATIONAL location. This data is presented below. 



Table I. SENSOR ARRAY 15 LOCATIONAL DATA. 



COMPONENT 


ACTUAL 

LOCATION 


INDUCED 

ERROR 


f 

RESULTANT ' 

OPERATIONAL 
LOCATION ! 


X (ft) 


53249.43 


11.00 


53260.43 


Y (ft) 


-6354 . 60 


28.00 


-6326.60 


Z (ft) 


1316.66 


-2 . 00 


1314 . 66 


xtilt 

(radians) 


0.003345 


0.0250 


0.028345 


ytilt 

(radians) 


0.004509 


0.0100 


0.014509 


zrot 

(radians) 


0.581544 


-0.0100 


0.571544 
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Shown below (Figure 12) , is a two dimensional depiction of 
sensor array 15 in both the ACTUAL and OPERATIONAL locations. 




OPERATIONAL Location of Sensor 
Array 15. 



In evaluating this array, the triple overlap regions 
associated with it will be defined in according to the 
following numbering scheme (refer to Figure 3) : 

SERVING ARRAYS REGION 



15,14,24 


13 


15, 5,14 


14 


15, 5, 6 


15 


15, 6,16 


21 


15,16,25 


22 


15,24,25 


23 



38 



with the above numbering system, sensor array 15 
(OPERATIONAL) , and its six satellites produce the following 
posloc data by region: 



REGION 13 



X posloc 
y posloc 
Z posloc 

PHS 

PHL 

THS 

THL 

HS 

HL 



ARRAY 15 

49502.98 

-8599.35 

485.07 

-2.60112 

-2.60333 

0.19055 

0.20163 

4376.31 

4366.69 



ARRAY 14 

49493.30 

-8593.79 

400.00 

-0.50009 

-0.49714 

0.21122 

0.20287 

4383.21 

4390.90 



ARRAY 24 

49493.30 

-8593.79 

400.00 

1.58474 

1.58175 

0.20692 

0.19853 

4362.25 

4369.78 



LONGBASE 

49506.25 

-8586.09 

436.63 



TRUTH 

49493.30 

-8593.79 

400.00 



REGION 14 



X posloc 
y posloc 
Z posloc 

PHS 

PHL 

THS 

THL 

HS 

HL 



ARRAY 15 

49371.89 

-4363.58 

510.17 

2.66930 

2.66441 

0.18565 

0.21244 

4361.03 

4337.52 



ARRAY 5 

49404.92 

-4356.84 

400.00 

-1.59591 

-1.59648 

0.21220 

0.21367 

4319.56 

4318.19 



ARRAY 14 

49404.92 

-4356.84 

400.00 

0.51668 

0.51724 

0.21411 

0.21557 

4322.25 

4320.87 



LONGBASE 

49402.52 

-4356.84 

393.66 



TRUTH 

49402.92 

-4356.84 

400.00 
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REGION 15 



X posloc 
Y posloc 
Z posloc 

PHS 

PHL 

THS 

THL 

HS 

HL 



ARRAY 15 

53178.27 

-2053.41 

421.31 

1.58878 

1.57543 

0.20833 

0.22296 

4294.82 

4281.08 



ARRAY 5 

53235.75 

-2085.69 

400.00 

-0.50279 

-0.49884 

0.21566 

0.22542 

4248.10 

4238.82 



ARRAY 6 

53235.75 

-2085.69 

400.00 

-2.63487 

-2.63884 

0.21393 

0.22368 

4249.12 

4239.91 



LONGBASE 

53235.67 

-2066.51 

358.59 



TRUTH 

53235.75 

-2085.69 

400.00 



REGION 21 



X posloc 
Y posloc 
Z posloc 

PHS 

PHL 

THS 

THL 

HS 

HL 



ARRAY 15 

57018.62 

-4259.21 

308.48 

0.50664 

0.48823 

0.23287 

0.21976 

4303.74 

4316.75 



ARRAY 6 

57054.98 

-4330.68 

400.00 

-1.54664 

-1.54360 

0.21107 

0.21920 

4308.39 

4300.74 



ARRAY 16 

57054.98 

-4330.68 

400.00 

2.65435 

2.65132 

0.21130 

0.21939 

4329.57 

4321.91 



LONGBASE 

57067.90 

-4322.70 

364.99 



TRUTH 

57054.98 

-4330.68 

400.00 
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REGION 22 



X posloc 
Y posloc 
Z posloc 

PHS 

PHL 

THS 

THL 

HS 

HL 



ARRAY 15 

57060.74 

-8516.21 

285.63 

-0.51801 

-0.53291 

0.23391 

0.20617 

4379.83 

4407.10 



ARRAY 16 

57054.15 

-8587.96 

400.00 

-2.61390 

-2.61448 

0.20669 

0.20498 

4429.02 

4430.60 



ARRAY 25 

57054.15 

-8587.96 

400.00 

1.55241 

1.55302 

0.18370 

0.18199 

4416.12 

4417.52 



LONGBASE 

57051.49 

-8586.52 

407.54 



TRUTH 

57054.15 

-8587.96 

400.00 



REGION 23 







ARRAY 15 


ARRAY 24 


ARRAY 25 


LONGBASE 


TRUTH 




X 


posloc 


53322.58 


53293.11 


53293.11 


53293.83 


53293. 


11 


Y 


posloc 


-10673.91 


-10707.34 


-10707.34 


-10689.88 


-10707. 


34 


Z 


posloc 


373.46 


400.00 


400.00 


447.16 


400. 


00 




PHS 


-1.55529 


0.54138 


2.58376 










PHL 


-1.56197 


0.54471 


2.58026 










THS 


0.21740 


0.20689 


0.18696 










THL 


0.20040 


0.19609 


0.17609 










HS 


4326.89 


4362.89 


4337.38 










HL 


4342.51 


4372.52 


4346.04 
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Summarizing the above data into the error table gives the 



following: 



TABLE II. ERROR TABLE FOR SENSOR ARRAY 15 (ERROR FREE 
SATELLITES/ ISOSPEED DVP) 





REGION 


Attribute 


13 


14 


15 


21 


22 


23 


t THER 


0.01108 


0.02679 


0.01463 


-0.01311 


-0.02775 


-0.01700 


PHER 


-0.00222 


-0.00489 


-0.01335 


-0.01840 


-0.01940 


-0.00668 


HER 


-9.622 


-23.501 


-13.739 


13.010 


27.266 


15.624 


XER 


3.278 


30.627 


57.394 


49.280 


-9.248 


-28.753 


YER 


13.258 


8.178 


-13.091 


-63.494 


-70.306 


-15.975 


ZER 


-48.436 


-116.508 


-62.719 


56.502 


121.910 


73.699 



This test case shows the depth exaggeration produced by 
LONGBASE. The poslocs generated do not approximate those 
normally encountered on the range. This is not expected since 
only one array is mispositioned while its satellites are error 
free . 

Submitting this data to ERRFIX the following solution is 
returned after 13 passes. (The algorithm was terminated on 
the 5 bad steps criteria, so only 8 passes were needed to 
produce the solution.) 
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TABLE III. SENSOR ARRAY 15 ERROR CORRECTION DATA (ERRFIX) . 
ERROR FREE SATELLITES - ISOSPEED DVP. 



j 

I 


INDUCED 

ERROR 


CORRECTED 

SHIFT 


! X (ft) 


11.000 


-11.000 


Y (ft) 


-2 . 000 


-28.000 


z (ft) 


-2 . 000 


2.000 


xtilt 

(radians) 


0.02500 


-0.02500 


ytilt 

(radians) 


0.01000 


-0.01000 


zrot 

(radians) 


-0.01000 


0.01000 



The solution presented above for array 15 is accurate to 
the thousandth of a foot and less than a hundred thousandth of 
a radian. The above solution was achieved without utilizing 
the ANNEAL algorithm. 

Several other test cases for array 15 were run to verify 
the algorithm following the same format as above. The results 
of the induced ERROR and the corrected SHIFT are presented on 
the next page (Table IV) . 
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B. INTERIOR ARRAY CORRECTION (SATELLITES WITH ERRORS/ 

ISOSPEED DVP) 

The ERRFIX and ANNEAL algorithms are now checked for 
performance on an interior array whose satellites contain 
locational errors. Array 15 is again chosen as the array of 
interest. The ERRORS induced on the arrays are such that 
array 15 will have the largest objective function with respect 
to its satellites. Table V on the next page, displays the 
ERRORS induced for all the arrays. These ERRORS were chosen 
so as to obtain initial posloc data similar to that normally 
seen on the range. Appendix H displays the regional posloc 
data . 

Submission of this data to ERRFIX produced the following 
corrections to array 15 (Table VI) after one pass. ERRFIX was 
exited after 11 passes, the last five non improving. With the 
exception of the ytilt component, the locational errors are 
reduced by 65 to 97%. The ytilt component was over corrected 
and increased its error magnitude by 142%. Table VI also 
shows the cumulative corrections produced by ANNEAL, using the 
ERRFIX corrections as input. The y and ytilt component errors 
are improved in ANNEAL while the other component errors are 
degraded. This supports the previous assessment of 
iteratively correcting the arrays iteratively through ERRFIX 
before attempting ANNEAL. 
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TABLE VI. ACCUMULATED CORRECTIONS FOR ARRAY 15. ERROR 
INDUCED SATELLITES - ISOSPEED DVP. 



COMPONENT 


INDUCED 


ERRFIX 


ANNEAL 




ERROR 


CORRECTION 


CORRECTION 


1 X (ft) 


11.000 


-11.756 


-15.789 1 


Y (ft) 


28.000 


-35.444 


-29.434 


Z (ft) 


-2.000 


2.706 


4.577 


xtilt 

(radians) 


0.00400 


-0.00444 


-0.00727 


ytitlt 

(radians) 


0.00500 


-0.01209 


-0.00714 


zrot 


-0.01000 


0.00973 


0.00942 


(radians) 









C. CORRECTION OF MULTIPLE INTERIOR ARRAYS (ISOSPEED DVP) 

After verifying the ERRFIX and ANNEAL algorithms work 
properly, correction for multiple interior arrays are now 
preformed. ERRORS are induced in the six interior arrays (see 
Figure 3) of the range, 4, 5, 6, 14, 15, and 16. Table VII 
displays the induced ERRORS. The exterior arrays are all 
properly located in this example. 

It was necessary to place a 'no repeat' restriction on the 
arrays for entry into ERRFIX. This restriction prevented the 
CONTROL algorithm from cycling on one single array. Iterative 
passes through ERRFIX was terminated when all the objective 
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functions were less than one. 



The choice of one was 



arbitrarily chosen to speed convergence (entry to ANNEAL) . 
Due to the consistency of errors approach in ERRFIX, as the 
ACTUAL location is approached, the magnitude of the correction 
is decreased. Presented below (Tables VIII - XIII) are the 
corrections (SHIFTS) produced from ERRFIX at the termination 
criteria mentioned above. 



TABLE VIII. ACCUMULATED CORRECTIONS FOR ARRAY 4. 
ERROR INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 



COMPONENT 


INDUCED 

ERROR 


ERRFIX 

CORRECTION 


ANNEAL 

CORRECTION 


X (ft) 


-0.500 


0.420 


0.506 


Y (ft) 


-1.000 


0.664 


0.59S 


Z (ft) 


0.700 


-0.589 


0.668 


xtilt 

(radians) 


-0.00600 


0.00594 


0.00599 


ytitlt 
(radians) ' 


0.00300 


-0.00288 


-0.00298 


zrot 

(radians) 


-0.00200 


0.00206 


0.00200 
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ERROR 



TABLE IX. ACCUMULATED CORRECTIONS FOR ARRAY 5. 
INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 



COMPONENT 


INDUCED 


ERRFIX 


ANNEAL 




ERROR 


CORRECTION 


CORRECTION 


X (ft) 


7.900 


-7.728 


-7.978 


Y (ft) 


-6.200 


5.563 


6.159 


Z (ft) 


-1.800 


2.846 


1.939 


xtilt 

(radians) 


0.00700 


-0.00677 


-0.00702 


ytitlt 

(radians) 


-0.00300 


0.00294 


0.00298 


zrot 


0.00100 


-0.00099 


-0.00100 


(radians) 









TABLE X. ACCUMULATED CORRECTIONS FOR ARRAY 6. ERROR 
INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 



COMPONENT 


INDUCED 

ERROR 


ERRFIX 

CORRECTION 


ANNEAL 

CORRECTION 


X (ft) 


-5.000 , 


5.373 


4.975 


Y (ft) 


7 . 000 


-7.936 


-7.009 


Z (ft) 


4 . 000 


-2.754 


3.808 


Xtilt 

(radians) 


0.00500 


-0.00499 


-0.00498 


ytitlt 

(radians) 


0.00200 


-0.00243 


-0.00200 


zrot 

( radians) 


-0.00300 


0.00297 


0.00300 
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TABLE XI. ACCUMULATED CORRECTIONS FOR ARRAY 14. ERROR 
INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 



COMPONENT 


INDUCED 


ERRFIX 


ANNEAL 




ERROR 


CORRECTION 


CORRECTION 


X (ft) 


4.000 


-3.941 


-4.027 1 


Y (ft) 


28.000 


8.009 


7.994 


Z (ft) 


5.000 


-4.917 


4.994 


xtilt 

(radians) 


-0.00900 


0.00915 


0.00901 


ytitlt 
j (radians) 


-0.00400 


0.00392 


0.00401 


zrot 


0.00300 


-0.00298 


-0.00300 


(radians) 









TABLE XII. ACCUMULATED CORRECTIONS FOR ARRAY 15. 
ERROR INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 



COMPONENT 


INDUCED 


ERRFIX 


ANNEAL 




ERROR 


CORRECTION 


CORRECTION 


X (ft) 


11.000 


-10.650 


-11.029 1 


Y (ft) 


28.000 


-28.858 




-28.019 


Z (ft) 


-2 . 000 


1.149 


2.064 


xtilt 

(radians) 


0.02500 


-0.02451 


-0.02499 


ytitlt 
1 (radians) 


0.01000 


-0.01020 


-0.01002 


zrot 


-0.01000 


0.01004 


0.01000 


(radians) 
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TABLE XIII. ACCUMULATED CORRECTIONS FOR ARRAY 16. 
ERROR INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 



COMPONENT 


INDUCED 


ERRFIX 


ANNEAL 




ERROR 


CORRECTION 


CORRECTION 


X (ft) 


5.000 


-5.203 


-5.004 


Y (ft) 


-2 . 000 


1.031 


2.001 


Z (ft) 


4 . 000 


-5.132 


-3.974 


xtilt 

(radians) 


0.00400 


-0.00336 


-0.00400 


ytitlt 

(radians) 


0.00200 


-0.00192 


-0.00200 


zrot 


0 . 00100 


-0.00102 


-0.00100 


(radians) 









ERRFIX corrected well for all locational components except 
depth. The corrections provided by ERRFIX left errors of at 
most 58% remaining (depth correction for array 5) . The only 
other locational component approaching this magnitude is the 
y component for array 16 (48% error remaining) . Internal 
passes through ERRFIX provided for improvements in all cases 
before termination (on 5 non improving passes) . 

Once all the interior array objective functions fell below 
one, control was passed to ANNEAL. The restriction of no 
'back to back' corrections for an array was also in place 
here. Convergence within ANNEAL was generally quick, with 



52 



termination occurring on 30 consecutive nonimproving steps 
accepted in the search. In order to maximize the potential 
for optimization, an internal control structure was added to 
ANNEAL to increase the step size and then decrease the bad 
step acceptance probability. As soon as a lower objective 
function value is found (over the previous minimum) , the 
parameters are returned to their initial values. ANNEAL 
termination occurs after 1500 passes with the larger step size 
and lower probability, if a lower objective function value has 
not been found. This exit condition was only invoked three 
times in the above test case. The results of ANNEAL 
performance (cumulative corrections) are displayed along with 
the ERRFIX corrections in Tables VIII to XIII. 

CONTROL was terminated when any array's objective function 
value increased after a return from ANNEAL. This occurred 
with array 15, after a total of 33 array entrances into ANNEAL 
(this was array 15 's seventh entry to ANNEAL). 
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VI 



CONCLUSIONS AND RECOMMENDATIONS 



A. RESULTS 

The goal of this thesis was to investigate interior sensor 
array locational errors, and develop a set of decision rules 
to correct any errors that may exist. The primary tools used 
here include, long baseline methodology and a consistency of 
errors approach. 

It was found that although LONGBASE was written under the 
caveat of no positional array errors existing, it could still 
be used to aid in correction of an array's location. In fact 
it worked better than using an averaged consensus posloc (of 
the three SBL poslocs) to compare the SBL poslocs against. 

The current research did not assume that the exterior 
arrays (those with fewer than six triple overlap regions) were 
locationally in error. Investigation of their inclusion into 
the error correction methodology was not conducted, so their 
effect on the algorithms is undetermined. The test cases r^n 
in this study also used an isospeed DVP. Appendix A addresses 
the effects of a DVP containing a gradient. The resultant 
gradient induced errors resulting from the use of Professor 
Read's recommended ray tracing initialization method, are 
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shown to be small in magnitude. Time constraints prevented a 
study of their effect on the error correction scheme. 

The final algorithms, ERRFIX and ANNEAL, have demonstrated 
excellent robustness in the correction of locational errors. 
An annealing algorithm, by itself, may be able to successfully 
minimize array locational errors. Since the array's location 
is six dimensional, it was deemed unreasonable to rely solely 
on this technique in order to keep computer run time down. 
The error correction algorithms were written so as to be able 
to accept raw tracking data from the range. The data used in 
the study here was internally generated to eliminate any 
systematic error sources commonly found in an underwater 
tracking situation. Times provided by the range are generally 
suspect in themselves, thus preventing 'error free' posloc 
determination. 

B. RECOMMENDATIONS FOR FURTHER RESE7VRCH 

In expanding this technique to the entire tracking range, 
three problems need to be analyzed. 

First, there is the treatment of exterior arrays. The use 
of these arrays in the current methodology may have 
insufficient consistency of errors to provide locating 
information. The use of double overlap regions [Refs. 4,5, 
and 6], may be necessary to supply enough data to accurately 
correct these exterior arrays. 



55 



Second, the optimization of the internal control 
parameters in the ERRFIX, ANNEAL and CONTROL algorithms is 
necessary before attempting entire range correction. This 
will also reduce computer run time allowing for more frequent 
calibration updates. The run times in solving for a single 
array with error free satellites was on the order of 5 
minutes. The case of solving for all the interior arrays 
required about one and half hours. 

The third area of work, is the effect of gradient water 
environments. Although the errors seen resulting from the 
gradients are 'small', the effect on an iterative correction 
scheme may be multiplictative thus inhibiting the correction 
of the true locational errors. 
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APPENDIX A: GRADIENT DVPs AND RAY TRACING INITIALIZATION 



An isospeed DVP was used during the formulation of this 
correction method. This had the advantage of eliminating 
extraneous errors from the analysis. 

About third of posloc errors were estimated to be due to 
the ray tracing initialization in a gradient DVP environment. 
The study performed in reference 1, showed that the current 
ray tracing initialization method used by NUWES produced 
errors on the order of feet in depth and horizontal range, and 
third decimal place (radians) in elevation and azimuth angles. 
The method recommended by Professor Read reduced these errors 
by a factor of 10 for depth, horizontal range, and elevation 
angle, and a factor of 100 for azimuth angle. 

Figure 4 of reference 1, showed a sinusoidal nature to 
each of the above error components. The skewed nature of the 
curves produced made direct analysis difficult. Standardizing 
the array axis (setting xtilt = ytilt = zrot = 0) produced the 
following curves (Figure 13). This figure mimics Figure 4 of 
reference 1, array 1 with the DVP of 3/22/89 used for sound 
sources at 3000, 4000 and 5000 feet. 

With a standardized local coordinate system the sinusoidal 
nature of the errors becomes visible. Analysis of the angular 
errors (azimuth and elevation angles) shows the errors to be 
90° out of phase. The zero error points for azimuthal error 
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Figure 13. Gradient Induced Sinusoidal Errors. 
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occurs at 45° and 235° rotation (CCW from east, the x axis) . 
This corresponds to the point where the sound source is 
equidistant from both the x and y hydrophones. The maximum 
azimuthal error occurs at 135° and 325°, 90° out from the zero 
errors. These points are where the sound source has maximum 
distance to one of the hydrophones (x or y) , and minimum 
distance to the other. The elevation angles display the 
opposite phenomenon, maximum errors where the sound source is 
equidistant form the x and y hydrophones, and zero error at 
the maximum/ minimum distance to one or the other. 

This effect on the errors is traced back to the geometric 
construction of the posloc point to initialize Professor 
Read's ray tracing method. A constant speed of sound in water 
is used to construct this posloc point. This speed of sound 
used (the speed at the level of the x, y, and c hydrophones) 
is larger than the speed found along the ray path. (Speed of 
sound in water generally decreases as you get shallower.) 
This larger speed of sound used causes the distance traveled 
back along the ray path to be longer than it is in reality. 
Thus the sinusoidal nature of the errors occur with respect to 
the array axis, or the sides of the pyramid constructed to 
locate the posloc. The discrepancies observed in figure 13 
are the result of time differences (time from constructed ray 
paths versus real transit times) in the ninth and tenth 
decimal place. 



59 



Before proceeding in an attempt to correct the effect, the 
posloc errors produced are examined. Using array 15, with 
ERROR free satellites and an isogradient DVP (+ 0.08 ft/sec), 
the following correction data is produced (Table XIV) . 



TABLE XIV. CORRECTIONS FOR ARRAY 15 ERROR INDUCED 
SATELLITES - ISOGRADIENT DVP. 



COMPONENT 


INDUCED 


ERRFIX 


ANNEAL 




ERROR 


CORRECTION 


CORRECTION 


■ X (ft) 


' 11.000 


-11.001 


-11.001 


Y (ft) 


28 . 000 


-28 . 003 


-28.003 


Z (ft) 


-2 . 000 


1.994 


1.994 


xtilt 


0.02500 


-0.02505 


-0.02505 


(radians) 








ytitlt 


0.01000 


-0.01005 


-0.01005 


(radians) 








zrot 


-0 . 01000 


0.01000 


0 .01000 


(radians) 
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The following regional posloc data is provided to give the 
reader an idea as to the effect this gradient has on the 
poslocs. The magnitude of the posloc errors are proportional 
to the gradient of the DVP. 



REGIONAL POSLOC DATA BEFORE ERRFIX 







REGION 13 










ARRAY 15 SBL 


ARRAY 14 SBL 


ARRAY 24 SBL 


LONGBASE 


GOAL 


X 


49502.76 


49493.37 


49493.35 


49506.26 


49493.30 


Y 


-8600.14 


-8593.79 


-8593.85 


-8586.09 


-8593.79 


Z 


484.96 


400.27 


399.72 


435.37 


400.00 


THS 


0.18338 


0.20397 


0.19983 






THL 


0.19475 


0.19595 


0.19164 






PHS 


-2.60099 


-0.50009 


1.58473 






PHL 


-2.60333 


-0.49714 


1.58175 






HS 


4376.91 


4383.27 


4362.19 






HL 


4366.68 


4390.91 


4369.79 










REGION 14 










ARRAY 15 SBL 


ARRAY 5 SBL 


ARRAY 14 SBL 


LONGBASE 


GOAL 


X 


49371.31 


49404.88 


49404.99 


49402.53 


49404.92 


Y 


-4363.06 


-4356.78 


-4356.83 


-4355.41 


-4356.84 


Z 


509.94 


399.77 


400.26 


393.90 


400.00 


THS 


0.17852 


0.20517 


0.20696 






THL 


0.20527 


0.20654 


0.20844 






PHS 


2.66925 


-1.59592 


0.51667 






PHL 


2.66441 


-1.59647 


0.51724 






HS 


4361.78 


4319.51 


4322.31 






HL 


4337.51 


4318.20 


4320.87 










REGION 15 










ARRAY 15 SBL 


ARRAY 5 SBL 


ARRAY 6 SBL 


LONGBASE 


GOAL 


X 


53179.04 


53235.71 


53235.73 


53235.67 


53235.75 


Y 


-2053.32 


-2085.64 


-2085.75 


-2066.52 


-2085.69 


Z 


421.03 


399.72 


400.19 


359.91 


400.00 


THS 


0.20135 


0.20876 


0.20691 






THL 


0.21564 


0.21817 


0.21643 






PHS 


1.58860 


-0.50279 


-2.63486 






PHL 


1.57543 


-0.49884 


-2.63884 






HS 


4294.90 


4248.04 


4249.16 






HL 


4281.07 


4238.83 


4239.92 










REGION 21 










ARRAY 15 SBL 


ARRAY 6 SBL * 


ARRAY 16 SBL 


LONGBASE 


GOAL 


X 


57018.23 


57054.97 


57054.96 


57067.89 


57054.98 


Y 


-4260.02 


-4330.75 


-4330.62 


-4322.71 


-4330.68 


Z 


308.33 


400.30 


400.20 


366.14 


400.00 


THS 


0.22589 


0.20394 


0.20415 






THL 


0.21243 


0.21190 


0.21205 






PHS 


0.50651 


-1.54665 


2.65434 






PHL 


0.48823 


-1.54360 


2.65132 






HS 


4303.00 


4308.46 


4329.61 






HL 


4316.74 


4300.75 


4321.92 
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REGION 22 





ARRAY 15 SBL 


ARRAY 16 SBL 


ARRAY 25 SBL 


LONGBASE 


GOAL 


X 


57060.09 


57054.14 


57054.14 


57051.48 


57054.15 


Y 


-8515.56 


-8587.89 


-8588.02 


-8586.51 


-8587.96 


Z 


285.62 


399.90 


399.69 


407.29 


400.00 


THS 


0.22678 


0.19945 


0.17652 






THL 


0.19899 


0.19777 


0.17480 






PHS 


-0.51795 


-2.61391 


1.55241 






PHL 


-0.53290 


-2.61448 


1.55302 






HS 


4378.94 


4429.00 


4416.06 






HL 


4407.09 


4430.60 


4417.53 










REGION 23 










ARRAY 15 SBL 


ARRAY 24 SBL 


ARRAY 25 SBL 


LONGBASE 


GOAL 


X 


53323.36 


53293.16 


53293.10 


53293.81 


53293.11 


Y 


-10673.68 


-10707.40 


-10707.39 


-10689.86 


-10707.34 


Z 


373.44 


400.05 


399.89 


445.45 


400.00 


THS 


0.21032 


0.19972 


0.17987 






THL 


0.19366 


0.18930 


0.16935 






PHS 


-1.55511 


0.54136 


2.58377 






PHL 


-1.56197 


0.54472 


2.58026 






HS 


4326.67 


4362.90 


4337.36 






HL 


4342.48 


4372.52 


4346.07 









REGIONAL POSLOC DATA 


AFTER ERRFIX 










REGION 13 










ARRAY 15 SBL 


ARRAY 14 SBL 


ARRAY 24 SBL 


LONGBASE 


GOAL 


X 


49493.30 


49493.37 


49493.35 


49493.30 


49493.30 


Y 


-8593.79 


-8593.79 


-8593.85 


-8593.79 


-8593.79 


Z 


399.99 


400.27 


399.72 


400.00 


400.00 


THS 


0.20342 


0.20397 


0.19983 






THL 


0.20342 


0.20403 


0.19976 






PHS 


-2.60761 


-0.50009 


1.58473 






PHL 


-2.60761 


-0.50009 


1.58474 






HS 


4358.54 


4383.27 


4362.19 






HL 


4358.55 


4383.20 


4362.25 










REGION 14 










ARRAY 15 SBL 


ARRAY 5 SBL 


ARRAY 14 SBL 


LONGBASE 


GOAL 


X 


49404.92 


49404.88 


49404.99 


49404.92 


49404.92 


Y 


-4356.84 


-4356.78 


-4356.83 


-4356.84 


-4356.84 


Z 


400.00 


399.77 


400.26 


400.00 


400.00 


THS 


0.20440 


0.20517 


0.20696 






THL 


0.20440 


0.20512 


0.20702 






PHS 


2.65763 


-1.59592 


0.51667 






PHL 


2.65763 


-1.59591 


0.51668 






HS 


4338.39 


4319.51 


4322.31 






HL 


4338.39 


4319.56 


4322.25 
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REGION 15 










ARRAY 15 SBL 


ARRAY 5 SBL 


ARRAY 6 SBL 


LONGBASE 


GOAL 


X 


53235.75 


53235.71 


53235.73 


53235.75 


53235.75 


Y 


-2085.69 


-2085.64 


-2085.75 


-2085.69 


-2085.69 


Z 


400.01 


399.72 


400.19 


400.00 


400.00 


THS 


0.20680 


0.20876 


0.20691 






THL 


0.20680 


0.20870 


0.20696 






PHS 


1.57297 


-0.50279 


-2.63486 






PHL 


1.57297 


-0.50279 


-2.63487 






HS 


4289.76 


4248.04 


4249.16 






HL 


4289.76 


4248.10 


4249.12 










REGION 21 










ARRAY 15 SBL 


ARRAY 6 SBL 


ARRAY 16 SBL 


LONGBASE 


GOAL 


X 


57054.98 


57054.97 


57054.96 


57054.98 


57054.98 


Y 


-4330.68 


-4330.75 


-4330.62 


-4330.68 


-4330.68 


Z 


400.00 


400.30 


400.20 


400.00 


400.00 


THS 


0.20511 


0.20394 


0.20415 






THL 


0.20511 


0.20401 


0.20420 






PHS 


0.49257 


-1.54665 


2.65434 






PHL 


0.49257 


-1.54665 


2.65435 






HS 


4323.92 


4308.46 


4329.61 






HL 


4323.92 


4308.39 


4329.57 










REGION 22 










ARRAY 15 SBL 


ARRAY 16 SBL 


ARRAY 25 SBL 


LONGBASE 


GOAL 


X 


57054.15 


57054.14 


57054.14 


57054.15 


57054.15 


Y 


-8587.96 


-8587.89 


-8588.02 


-8587.96 


-8587.96 


Z 


400.00 


399.90 


399.69 


400.00 


400.00 


THS 


0.20118 


0.19945 


0.17652 






THL 


0.20118 


0.19942 


0.17646 






PHS 


-0.52622 


-2.61391 


1.55241 






PHL 


-0.52622 


-2.61390 


1.55241 






HS 


4405.03 


4429.00 


4416.06 






HL 


4405.03 


4429.02 


4416.12 










REGION 23 










ARRAY 15 SBL 


ARRAY 24 SBL 


ARRAY 25 SBL 


LONGBASE 


GOAL 


X 


53293.11 


53293.16 


53293.10 


53293.11 


53293.11 


Y 


-10707.34 


-10707.40 


-10707.39 


-10707.34 


-10707.34 


Z 


399.99 


400.05 


399.89 


400.00 


400.00 


THS 


0.20470 


0.19972 


0.17987 






THL 


0.20470 


0.19973 


0.17984 






PHS 


-1.55971 


0.54136 


2.58377 






PHL 


-1.55971 


0.54138 


2.58376 






HS 


4332.16 


4362.90 


4337.36 






HL 


4332.16 


4362.89 


4337.38 
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After ERRFIX, and array 15 has almost all of its 
locational errors corrected. The remaining errors are seen in 
every array and are the result of the gradient. The LBL 
poslocs generated in this environment are coincident with the 
true (goal) posloc. With error free arrays, the gradient does 
not prevent LONGBASE from accurately determining the targets 
position. 
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APPENDIX B 



COMPUTER PROGRAMS SIMSTRT AND SETUP 



SUBROUTINE SIMSTRT ( DVP, EXT , RTIME , RORIGIN ) 

★ 

* THIS SUBROUTINE GENERATES THE TR7VNSIT TIMES (RTIME) FROM A 

* STARTING POINT ON THE RANGE (RORIGIN) WHICH IS GENERATED BY THE 
SUBROUTINE POINST. THIS SUBROUTINE IS TO INITIATE THE NANOOSE RANGE 

* SIMULATION FOR ERROR CORRECTIONS. THE OUTPUTS CREATED BY THIS 

* PROGRAM SHOULD BE THE SAME AS INPUTS RECEIVED BY THE RANGE (EXCEPT 

* RORIGIN WHICH IS USED TO MONITOR SIMULATION PROGRESS) 

■k 

INPUTS: 

* DVP : THE INDEX OF THE DEPTH VELOCITY PROFILE TO BE USED 

* EXT : EXTRAPOLATION CONTROL FOR SUBROUTINE VELPRO 



★ 



★ 



OUTPUTS : 

RTIME : ARRAY CONTAINING TRANSIT TIMES FROM A LOCATION TO A SENSOR 
DIMENSIONED AS FOLLOWS: ( SENSOR, REGION, I ) WHERE 1=1-4 THE 

TIMES FROM THE X,Y,Z,C PHONES RESPECTIVELY 
RORIGIN : ARRAY CONTAINING THE TRUE LOCATION OF THE TARGET IN RANGE 
COORDINATES, DIMENSIONED: (REGION,!) 1=1-3 FOR X,Y,Z 

J.A. GEMBARSKI 
NPS 03/01/02 



DIMENSION XP(3) ,YP(3) , ZP(3) ,CP(3) ,A(3) , RTIME ( 0 : 57 , 2 7 , 4 ) , 

& AR(3) ,XPHLOC(7,3) ,YPHLOC(7,3) ,ZPHLOC(7,3) ,CPHLOC(7,3) , 

& RORIGIN (2 7, 3) ,X(3) ,ORIGIN(6,3) , 

& L(300) ,VEL(300) , VO (300) , VI ( 300 ) , LM ( 300 ) , DZ ( 300 ) , 

& J(6) , LINKS (18) ,SENSR(7) ,XS(18,3) 

COMMON /SETl/ L , VEL , VO , VI , DZ , LM, M 



INTEGER SENSR, J , ERR, K, NR, H, KK, N, M, AR, LINKS , NSBL, S , 

& LP,MP,IEST,EXT,I,DVP 

DOUBLE PRECISION ORIGIN, XS , XPHLOC, YPHLOC , ZPHLOC , CPHLOC , X , A 
DOUBLE PRECISION XP , YP , ZP , CP , A1 , A2 , PI , P2 , VO , VI , LM, L , VEL , DZ 

DOUBLE PRECISION THl , TH2 , RTIME , RORIGIN 

LOGICAL TEST 
CHARACTER* 15 NAMEl 



DO 3 1=1,300 
L(I) =0.0 
VEL(I) =0.0 
VO ( I ) = 0.0 

V1(I) =0.0 

DZ(I) =0.0 
LM(I) = 0.0 
3 CONTINUE 
ERR = 0 
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DO 30 S =0,57 
SENSR(l) = S 

FIND THE CORRESPONDING OVERLAP REGIONS AND ADJACENT ARRAYS 

CALL FINDOVR(S, J,ERR) 

IF(ERR.EQ.l) GOTO 30 

NR = 1 

DO 10 LP = 1,6 

IF( J(LP) .NE.O) NR=NR+1 
10 CONTINUE 

NR = NR-1 

H=1 

K=1 

KK=2 

N=1 



12 IF( J(K) .NE.0)THEN 

LINKS(N)=1 

CALL OVERLAP (J (K) ,AR, ERR) 

DO 13 LP=1,3 
MP=1 

11 IF(SENSR(MP) .NE. AR(LP) )THEN 

TEST=. TRUE. 

MP=MP-a 

ELSE 

TEST=. FALSE. 

ENDIF 

IF(TEST.AND. MP.LT.KK) GOTO 11 

IF(TEST)THEN 

SENSR(KK)=AR(LP) 

LINKS (N-kH)=KK 

KK=KK+1 

H=H*fl 

ELSEIF(SENSR( 1) .NE. AR(LP) )THEN 
LINKS (N-HH)=MP 
H=H+1 
ENDIF 

13 CONTINUE 

H=1 

K=K+1 

N=N-k3 

IF(K.LE.6) GOTO 12 
ENDIF 

* 

* FIND THE NUMBER OF SHORT BASE LINE POSLOC NSBL 

* 

NSBL = N-1 

* 

* LOCATE THE TARGET POSLOC IN EACH CROSSOVER REGION 

* 

DO 14 LP=1,NR 

CALL POINTST( J(LP) , ORIGIN ( LP, 1 ), ORIGIN ( LP , 2 ) , ORIGIN ( LP , 3 ) ) 
DO 26 H = 1,3 

RORIGIN( J(LP) ,H) = ORIGIN(LP,H) 

26 CONTINUE 
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14 CONTINUE 



* IDENTIFY AN UNIQUE POSLOC FOR EACH ARRAY IN EACH CROSSOVER REGION 



DO 20 LP=1,NSBL 

XS(LP,l)=ORIGIN(H, 1) 
XS(LP, 2)=ORIGIN(H,2) 
XS(LP, 3)=ORIGIN(H,3) 
IF(MOD(LP,3) .EQ.O) H=H+1 
20 CONTINUE 



C IDENTIFY THE GLOBAL COORDINATES OF EACH HYDROPHONE OF EACH SENSOR 
C TO CALCULATE THE TRUE TRANSIT TIMES 

* 

A2 = 0.0 

DO 21 LP=1, (KK-1) 

CALL ARRAY ( SENSR (LP),X(1),X(2),X(3),A(1),A(2),A{3), ERR ) 

CALL GLOBE(X,A,XP,YP,ZP,CP) 

DO 22 N=l,3 

XPHLOC(LP, N)=XP(N) 

YPHLOC(LP,N)=YP(N) 

ZPHLOC(LP,N)=ZP(N) 

CPHLOC(LP,N)=CP(N) 

22 CONTINUE 

IF(XP(3) .GT.A2 )A2 = XP(3) 

IF(YP(3) .GT.A2 )A2 = YP(3) 

IF(ZP(3) .GT.A2)A2 = ZP(3) 

IF(CP(3) .GT.A2)A2 = CP ( 3 ) 

21 CONTINUE 



C RETRIEVE THE VELOCITY PROFILE INFORMATION 



■k 

c 

c 

c 

c 

★ 



IF(EXT.NE.2)EXT = 0 

CALL VELPRO (0, NAME 1,DVP, EXT, A2) 



CALCULATE TRANSIT TIMES FROM EACH POSLOC TO EACH HYDROPHONE 
THE SECOND INDEX ON TIME INDICATES THE HYDROPHONE: 1,2, 3, 4 FOR 
X,Y,Z,C RESPECTIVELY (THIS INFORMATION IS NORMALLY SUPPLIED BY 
THE RANGE) 



H = 1 

DO 25 LP=1,NSBL 
A1 = O.ODO 

A2 = XPHLOC(LINKS(LP) , 3) 

PI = DSQRT( (XS(LP,l)-XPHLOC(LINKS(LP),l) )**2 + 

H (XS(LP,2)-XPHLOC(LINKS(LP),2) )**2 ) 

P2 = XS(LP,3) 
lEST = 0 

CALL RAYFITl ( A1 , A2 , PI , P2 , M, VEL , LM, DZ , VO , VI , 

; RTIME(SENSR(LINKS(LP) ) ,J(H) ,1) , TH2 , THl , lEST ) 

A2 = YPHLOC(LINKS(LP) , 3) 

PI = DSQRT{ (XS(LP, l)-YPHLOC(LINKS(LP) , 1) ) **2 + 

^ (XS(LP,2)-YPHLOC(LINKS(LP) ,2) )**2 ) 

lEST = 0 



CALL RAYFITl ( Al, A2, PI, P2,M, VEL, LM,DZ, VO, VI, 

RTIME( SENSR ( LINKS (LP) ) , J(H) ,2) , TH2 , THl , lEST ) 
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A2 = ZPHLOC(LINKS(LP) ,3) 

PI = DSQRT( (XS(LP, l)-ZPHLOC(LINKS(LP) , 1) )*»2 + 

(XS(LP,2)-ZPHLOC(LINKS(LP) ,2) )**2 ) 

lEST = 0 



CALL RAYFIT1(A1,A2,P1,P2,M,VEL,LM,DZ,V0,V1, 

& RTIME(SENSR( LINKS (LP) ) , J(H) ,3) , TH2 , THl , lEST ) 

A2 = CPHLOC(LINKS(LP) , 3) 

PI = DSQRT( (XS(LP,l)-CPHLOC(LINKS(LP) ,1) )**2 + 

+ (XS(LP,2)-CPHLOC(LINKS(LP) ,2) )**2 ) 

lEST = 0 



Sc 



CALL RAYFIT1(A1,A2,P1,P2,M,VEL,LM,DZ, V0,V1, 

RTIME(SENSR( LINKS (LP) ) , J(H) , 4) , TH2 , THl , lEST ) 



IF(MOD(LP,3) .EQ.O) H= H+1 



25 CONTINUE 
30 CONTINUE 
RETURN 
END 
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SUBROUTINE SETUP ( DVP, EXT, RTIME , RSHIFT , RSENSR, RLINKS , RJ, RDATA, 

& RERRTAB , RXS , RXL , RNR , ROB J ) 

★ 

* THIS SUBROUTINE TAKES TRANSIT TIMES AND DVP INFORMATION FOR THE 

* RANGE AND GENERATES THE RANGE ARRAYS RSENSR, RLINKS , RJ AND RDATA, 

* RERRTAB FOR INPUT INTO THE RANGE CONTROL PROGRAM. 



★ 



* 



INPUTS: 

DVP 

EXT 

RTIME 



RSHIFT 



OUTPUTS : 
RSENSR 

RLINKS 

RJ 

RDATA 



RERRTAB 



RXS 

RXL 

RNR 



THE DVP PROFILE CURRENTLY IN USE 

DVP EXTRAPOLATION CONTROL (2= DO NOT EXTRAPOLATE DVP) 

ARRAY HOUSING THE TRANSIT TIMES FROM SENSOR NUMBER 
(FIRST ELEMENT) TO REGION (SECOND ELEMENT) FOR HYDROPHONES 
X,YZ,C RESPECTIVELY (THIRD ELEMENT) 

ARRAY HOUSING SENSOR REPOSITIONING INFORMATION FOR SENSOR 
(FIRST ELEMENT) AND DIRECTION X , Y , Z , XTILT , YTILT, ZROT 
RESPECTIVELY (SECOND ELEMENT) 

ARRAY HOUSING THE CENTER SENSOR AND ITS TRIPLE OVERLAP 
SATELLITES (FIRST INDEX SENSOR, SECOND ARRAY SENSR(I)) 
ARRAY HOUSING THE LINKS (ENSOR) ARRAY FOR EACH SENSOR 
(FIRST ELEMENT) 

ARRAY HOUSING THE OVERLAP REGIONS ASSOCIATED WITH EACH 
SENSOR (FIRST INDEX) STORING J(I) ARRAY 
DATA ARRAY FOR RANGE CONTAINING PHS , PHL , THS , THL , HS , HL 
(THIRD INDEX) ARRAYS FOR A GIVEN CENTER ARRAY (FIRST 
INDEX) TO A GIVEN REGION (SECOND INDEX) 

ARRAY CONTAINING THE ERROR ARRAYS THER, PHER, HER, XER, YER, 
ZER (THIRD INDEX) FOR A GIVEN CENTER ARRAY (FIRST INDEX) 

TO A GIVEN REGION (SECOND INDEX) 

RANGE SBL ARRAY FOR THE GIVEN CENTER SENSOR (FIRST INDEX) 
TO A GIVEN REGION (SECOND INDEX) 

RANGE LBL ARRAY FOR THE GIVEN CENTER SENSOR REGION 
(FIRST INDEX) 

ARRAY CONTIANING NUMBER OF REGIONS ASSOCIATED WITH EACH 
CENTER SENSOR 

J.A. GEMBARSKI 
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DIMENSION 

Sc 

Sc 

Sc 

Sc 

Sc 

Sc 

Sc 

Sc 

Sc 



XP(3) ,YP(3) ,ZP(3) ,CP(3) ,A(3) ,HOLD(6) , 

AR ( 3 ) , XPHLOC (7,3), YPHLOC (7,3), ZPHLOC (7,3), CPHLOC (7,3), 
XS(18,3) ,XL(6,3) ,X(3) ,TIME(18,4) , 

L(300) ,VEL(300) , VO (300) , VI ( 300 ) , LM ( 300 ) , 

DZ(300) , SHIFT (7, 6) , RSHIFT ( 0 : 57 , 6 ) , LINKS (18) , 

NEW(3) , THL (18) ,HS(18) ,SENSR(7) , J(6) , 

THS (18) ,HL( 18) , PHS ( 18) ,PHL( 18) , ERROR ( 7 , 6 ) , 
RTIME(0:57,27,4) , RSENSR( 0 : 57 , 7 ) , RLINKS ( 0 : 57 , 18 ) , 

RJ(0: 57, 6) ,RDATA(0: 57,27,6) , RERRTAB ( 0 : 57 , 27 , 6 ) , 

RXS (0:57, 27, 3) ,RXL(27,3) , RNR (0:57) ,ROBJ(0:57) 



COMMON /SETl/ L , VEL , VO , VI , DZ , LM, M 



★ 



★ 



INTEGER SENSR, J, ERR, K, NR, H,KK,N,M,AR, LINKS, NSBL,S, 
+ LP , MP , EXT , I , DVP , R J , RL I NKS , RSENSR , RNR 



DOUBLE PRECISION 
DOUBLE PRECISION 
DOUBLE PRECISION 
DOUBLE PRECISION 

LOGICAL TEST 



XS , XL , XPHLOC , YPHLOC , ZPHLOC , CPHLOC , X , A 

XP , YP , ZP , CP , VO , VI , LM , L , VEL , D Z , RTIME , RSH I FT 

NEW , THL , HOLD , RXS , RXL , RERRTAB , RDATA 

TIME , PHS, PHL, HL, HS , THS , SHIFT, ERROR, ROB J, W 
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o o 



CHARACTER’^15 NAKEl 

★ 

ERR = 0 

★ 

C RETRIEVE THE VELOCITY PROFILE INFORMATION 

★ 

IF ( EXT. NE. 2) EXT = 0 

CALL VELPRO (1, NAME 1,DVP, EXT, A2) 

C S = 15 

DO 50 S=0,57 

DO 111 1=1,7 

SENSR(I) = -1.0 
111 CONTINUE 

SENSR(l) = S 

* 

FIND THE CORRESPONDING OVERLAP REGIONS AND ADJACENT ARRAYS 
IF NONE EXIST SKIP THIS S(ENSOR) 

* 

CALL FINDOVR(S, J,ERR) 

IF(ERR.EQ.l) THEN 
ROBJ(S) = -l.ODO 
GOTO 50 
ENDIF 

NR = 1 

DO 10 LP = 1,6 

IF( J(LP) .NE.O) NR=NR+1 

10 CONTINUE 

NR = NR-1 
RNR(S) = NR 

DO 51 I =1,6 

RJ(S,I) = J(I) 

51 CONTINUE 

H=1 

K=1 

KK=2 

N=1 

12 IF( J(K) .NE.0)THEN 
LINKS(N)=1 

CALL OVERLAP ( J ( K ) , AR , ERR ) 

DO 13 LP=1,3 
MP=1 

11 IF(SENSR(MP) .NE. AR(LP) )THEN 

TEST=.TRUE. 

MP=MP+1 

ELSE 

TEST=. FALSE. 

ENDIF 

IF(TEST.AND. MP.LT.KK) GOTO 11 

IF (TEST) THEN 

SENSR(KK)=AR(LP) 

LINKS (N+H)=KK 
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KK=KK+1 

H=H+1 

ELSEIF ( SENSR ( 1 ) . NE . AR ( LP ) ) THEN 
LINKS (N+H)=MP 
H=H + 1 
ENDIF 
13 CONTINUE 



H=1 

K=K+1 

N=N+3 

IF(K.LE.6) GOTO 12 
ENDIF 

DO 52 I = 1,18 

RLINKS(S,I) = LINKS(I) 

52 CONTINUE 

DO 53 I =1,7 

IF(SENSR(I) .EQ.-l) GOTO 53 
RSENSR(S,I) = SENSR(I) 

53 CONTINUE 



* FIND THE NUMBER OF SHORT BASE LINE POSLOC NSBL 

* 

NSBL = N-1 
C WRITE(90,202) 

C DO 40 1=1, 18 

C IF( I .LE. 6)WRITE(90, 203) I, SENSR( I ) , J(I ) , LINKS ( I ) ,LINKR( I ) 

C IF(I.EQ.7)WRITE(90,204)I,SENSR(I) ,LINKS(I) ,LINKR(I) 

C IF(I .LE. 12. AND. I .GT. 7 )WRITE(90, 205)1 ,LINKS (I ) ,LINKR(I ) 

C IF(I.GT. 12)WRITE(90,206)I,LINKS(I) 

C 40 CONTINUE 
C CLOSE (UNIT=90) 



C ESTABLISH INDUCED ERRORS FOR THE CENTER AND SATELLITE ARRAYS 
* 

DO 9 1=1,7 

CALL RERROR(SENSR(I) ,HOLD,ERR) 

DO 8 H = 1,6 

ERROR ( I , H ) = HOLD ( H ) 

8 CONTINUE 

9 CONTINUE 

* 

C RETRIEVE THE ARRAY SHIFT INFORMATION FOR PREVIOUS SHIFTS 

* 

DO 7 1=1,7 

DO 6 H = 1,6 

SHIFT(I,H) = RSHIFT(SENSR(I) ,H) 

6 CONTINUE 

7 CONTINUE 
K = 1 

DO 54 I =1,18 

IF(LINKS(I) .EQ.O) GOTO 54 
DO 55 H = 1,4 
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TIME(I,H) = RTIME(SENSR(LINKS(I) ) , J(K) ,H) 
55 CONTINUE 

IF(MOD(I,3) .EQ.O) K = K+1 
54 CONTINUE 



* PERFORM ARRAY SHIFTS FOR ALL SBL POSLOCS 



K = 1 

DO 77 I =1,NSBL 



CALL ARRAY (SENSR(LINKS(I) ) ,X(1) 


/X( 


2 ). 


X(3) ,A(1) ,A(2) ,A(3) ,ERR) 


X(l) 


= 


X(l) 


+ 


ERROR(LINKS(I) 


,1) 




SHIFT(LINKS(I) ,1) 


X(2) 


= 


X(2) 




ERROR(LINKS(I) 


, 2 ) 




SHIFT(LINKS(I) , 2 ) 


X(3) 


= 


X(3) 


+ 


ERROR(LINKS(I) 


,3) 




SHIFT(LINKS(I) ,3) 


A(l) 


= 


A(l) 




ERROR(LINKS(I) 


,4) 




SHIFT(LINKS(I) ,4) 


A(2) 


= 


A(2) 


+ 


ERROR(LINKS(I) 


-5) 


+ 


SHIFT(LINKS(I) ,5) 


A(3) 


= 


A(3) 




ERROR(LINKS(I) 


,6) 


+ 


SHIFT(LINKS(I) ,6) 



LP= LINKS(I) 

CALL GLOBE(X,A,XP, YP, ZP,CP) 

DO 32 N=l,3 

XPHLOC(LP,N)=XP(N) 

YPHLOC(LP,N)=YP(N) 

ZPHLOC(LP,N)=ZP(N) 

CPHLOC(LP,N)=CP(N) 

32 CONTINUE 

IF(ERROR(LINKS(I) ,3) .GT.O) THEN 
IF(EXT,NE. 2 )EXT = 1 
CALL VELPRO(0,NAME1,DVP,EXT,X(3) ) 

ENDIF 

CALL SHIFTER(X(3) ,A(1),A(2),A(3) , TIME , I , NEW , HS ( I ) , THS ( I ) ) 

XS(I,1) = CPHLOC(LINKS(I) , 1) + NEW ( 1 ) 

XS(I,2) = CPHLOC(LINKS(I) ,2) + NEW (2) 

XS(I,3) = NEW(3) 



IF(MOD(I, 3) .EQ.0)THEN 

CALL LONG (TIME, LINKS , SENSR , CPHLOC , K , XS , HS , THS , THL , PHS , PHL , HL , 
& XL) 

K=K+1 

ENDIF 

77 CONTINUE 

★ 

C BUILD THE RANGE ARRAYS 



K = 1 

DO 60 I = 1,NSBL 

RDATA ( SENSR ( LINKS ( I 
RDATA ( SENSR ( LINKS ( I 
RDATA ( SENSR (LINKS ( I 
RDATA (SENSR (LINKS ( I 
RDATA ( SENSR ( LINKS ( I 
RDATA ( SENSR ( LINKS ( I 
RXS(SENSR(LINKS(I) ) 
RXS( SENSR (LINKS(I) ) 



)) 
) ) 
) ) 
) ) 
) ) 
) ) 
,J 
, J 



, J(K) , 1) 


= 


THS( 


,J(K) ,2) 


= 


THL( 


,J(K),3) 


= 


PHS( 


,J(K) ,4) 


= 


PHL( 


,J(K) ,5) 


= 


HS( 


,J(K) ,6) 


= 


HL( 


(K),l) 


= 


XS ( 


(K),2) 


= 


XS ( 



I) 

I) 

I) 

I) 

I) 

I) 

I, 

I, 



1 ) 

2 ) 
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60 



RXS(SENSR(LINKS(I) ) , J(K) , 3) 
RERRTAB(SENSR(LINKS(I) ),J(K),1) 
RERRTAB ( SENSR (LINKS (I)),J(K),2) 
RERRTAB ( SENSR (LINKS (I)),J(K),3) 



XS(I,3) 

= THL(I) - THS(I) 
= PHL(I) - PHS(I) 
= HL(I) - HS(I) 



RERRTAB (SENSR (LINKS( I) ) ,J(K) ,4) 
RERRTAB(SENSR(LINKS(I ) ) , J(K) , 5) 
RERRTAB ( SENSR (LINKS( I) ) ,J(K) ,6) 
IF(MOD(I, 3) .EQ.O) K = K+1 
CONTINUE 



XL(K, 1) 
XL(K,2) 
XL(K,3) 



XS(I,1) 
XS ( I , 2 ) 
XS ( I , 3 ) 



DO 61 K = 1,NR 

RXL(J(K),1) = XL(K,1) 

RXL(J(K),2) = XL(K,2) 

RXL(J(K),3) = XL(K,3) 

61 CONTINUE 



W = O.ODO 
DO 62 1=1, NR 

W = W + DSQRT( (XL(I,3) -XS ( 3*1-2 , 3 ) ) **2 + 

& (HL(3*I-2)-HS(3*I-2) )**2 + 

& (HS ( 3*1-2 ) *(PHL( 3*1-2 )-PHS( 3* 1-2) ) )**2) 

62 CONTINUE 

ROBJ(S) = W/REAL(NR) 

50 CONTINUE 



RETURN 

END 
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APPENDIX C: COMPUTER PROGRAMS ERRFIX AND ANNEAL (AND SUPPORT PROGRAMS) 

Included with the FORTRAN programs ERRFIX and ANNEAL are the 
supporting programs NEWTILT and NEWERR. NEWTILT is the tilt correction 
subcomponent of ERRFIX. NEWERR is a subroutine designed to calculate the 
new error values from a SHIFT and output them if desired. 



SUBROUTINE ERRFIX ( TIME , J , LINKS , SENSR, DVP , EXT , NR, ORIGIN , XS , XL , THS , 
& THL , PHS , PHL , HS , HL , SHIFT , ERROR ) 

* 

* THIS SUBROUTINE IS THE ARRAY POSITION (SHIFT 1,2,3) AND ORIENTATION 
(SHIFT 4,5,6) CORRECTION ALOGRITHM, MINIMIZING SBL AND LBL POSLOCS. 



SBL POSLOCS 
LBL POSLOCS 

SBL ELEVATION ANGLES FROM C PHONE 
LBL ELEVATION ANGLES FROM C PHONE 
SBL AZIMUTHS 
LBL AZIMUTHS 

SBL HORIZONTAL DISTANCES FROM C PHONE 
LBL HORIZONTAL DISTANCES FROM C PHONE 
CORRECTIONS APPLIED TO CENTER ARRAY A.C. PREVIOUSLY 
X,Y,Z ARE THE 1,2,3 ELEMENTS ; 4 , 5 , 6 IDENTIFY THE TILTS 
(XTILT, YTILT, ZROT) 

ERROR: THE INDUCED ERRORS TO THE SENSOR POSITIONS (GIVING 

OPERATIONAL POSITIONS) FIRST INDEX CORRESPONDS TO SENSR(I) 
THE SECOND TO THE TYPE ( X , Y , Z , XTILT , YTILT , ZROT ) 

OUTPUTS; 

SHIFT; X,Y,Z MOVEMENT (FEET) TO BE APPLIED TO ARRAY A.C. 

XTILT, YTILT, ZROT CORRECTIONS (RADIANS) TO BE APPLIED 
TIME, J, LINKS, SENSR,DVP, EXT, NR, ORIGIN : SENSOR ARRAY DATA 
RECEIVED FROM FORTRAN PROGRAM CONTROL 
XS,XL,PHS,PHL,THS,THL : UPDATED VALUES OF THESE VECTORS 

J.A. GEMBARSKI 
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INPUTS; 

XS 

XL 

THS 

THL 

PHS 

PHL 

HS 

HL 

SHIFT 



DIMENSION 

Sc 

Sc 

Sc 

Sc 

Sc 



XS(18,3) ,XL(6,3) , THS (18) , THL (18) , PHS (18) , 

PHL (18) ,HS (18) ,HL(18) , SHIFT (7, 6) ,SENSR(7 ) , 

THER(6) ,PHER(6) ,HER(6) ,XER(6) ,YER(6) ,ZER(6) , CPH ( 7 , 3 ) , 
XPH(7, 3) , YPH(7, 3) , ZPH ( 7 , 3 ) , TIME ( 18 , 4 ) , J(6) , LINKS (18) , 
L(300) ,VEL(300) , VO (300) , VI (300) ,DZ(300) ,LM(300) , 
ORIGIN (6,3), ERROR (7,6),X(3),A(3), HOLD (7,6) 
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COMMON /SETl/ L , VEL, VO , VI , DZ , LM, M 

DOUBLE PRECISION XS, XL, THS,THL,PHS,PHL,HS,HL, TIME, SHIFT, TUNEl, 
& PHER,THER,HER,XER,YER, ZER, MI , MA, SUM,L, VEL, VO , VI , DZ ,LM, 

& ORIGIN, X, A, CPH , ZFI X , XPH , Y PH , ZPH , ERX , ERY , EPS , TUNE , ERROR , 

& TUNE2,TUNE3,W, OBJ, HOLD 

INTEGER J , LINKS , SENSR, NR, EXT , I , M, DVP , C, HC, BAD 

LOGICAL CHECKl 

OBJ = 500. ODO 
BAD = 0 
C = 0 

DO 29 1=1,6 

HOLD (1,1) = O.ODO 
29 CONTINUE 



C UPDATE POSITIONS OF C PHONES FROM PREVIOUS SHIFTS 



CALL UPDATE ( SENSR, DVP , EXT , SHIFT , ERROR, CPH , XPH , YPH , ZPH , X , A ) 

CALL NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 

& THER, PHER, HER,XER, YER, ZER, XS , XL, THS , THL, PHS , PHL, HS , HL) 



C 



FORM ERROR ARRAYS 



30 



DO 30 1=1, NR 
THER(I) = 
PHER(I) = 
HER(I) = 
XER(I) = 
YER(I) = 
ZER(I) = 
CONTINUE 



THL((3*I)-2) - THS((3*I)-2) 
PHL((3*I)-2) - PHS((3*I)-2) 
HL((3*I)-2) - HS((3*I)-2) 

XL(I,1) - XS( (3*I)-2,1) 
XL(I,2) - XS( (3*I)-2,2) 
XL(I,3) - XS( (3*I)-2,3) 



CHECKl = .FALSE. 
222 CONTINUE 



C 



ZROT CORRECTIONS 



CALL FIND(PHER,NR,MI ,MA) 

IF(MA.LT.O .OR. MI.GT.O) THEN 
SUM = 0.0 
DO 40 1=1, NR 

SUM = SUM + PHER(I) 

40 CONTINUE 

SHIFT(1,6) = SHIFT(1,6) - ( SUM/REAL ( NR) ) 

CALL NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 

& THER, PHER, HER, XER, YER, ZER, XS , XL, THS , THL, PHS , PHL, HS , HL) 

CHECKl = .TRUE. 

W = O.ODO 
DO 80 I =1,NR 

W = W+ DSQRT(ZER(I)**2 + HER(I)**2 + (HS ( 3 *1-2 ) *PHER( I ) ) **2 ) 
80 CONTINUE 

W = W/REAL(NR) 

GOTO 222 
ENDIF 
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C DEPTH CORRECTION FROM ELEVATION ANGLE ANALYSIS 



IF ( NR. EQ. 6) THEN 
ZFIX = 0.0 

CALL FIND(THER,NR,MI,MA) 

IF(MA.LT.O .OR. MI.GT.O)THEN 
SUM =0.0 
DO 60 1=1, NR 

SUM = SUM + ZER(I) /(REAL(NR) ) 

60 CONTINUE 

SHIFT(1,3) = SHIFT(1,3) + SUM 
CALL FIND(ZER,NR,MI,MA) 

CALL NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT , DVP , EXT , NR , ORIGIN , 
fi THER, PHER, HER, XER, YER, ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

CHECKl = .TRUE. 

W = O.ODO 
DO 81 I =1,NR 

W = W+ DSQRT(ZER(I)**2 + HER(I)**2 + ( HS ( 3 * 1-2 ) *PHER ( I ) ) * *2 ) 
81 CONTINUE 

W = W/REAL(NR) 

GOTO 222 
ENDIF 

ENDIF 



C ADJUST XTILT AND YTILT FOR THETA ERRORS 



IF(C.EQ.O. AND. CHECKl .OR. CHECKl) THEN 

CALL NEWTILT ( SENSR, DVP, EXT, PHL, THL, PHS , THS , NR, SHIFT, ERX, ERY , 

& ERROR) 

SHIFT(1,4) = SHIFT(1,4) + ERX 
SHIFT (1,5) = SHIFT(1,5) + ERY 

CALL NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP , EXT , NR, ORIGIN , 

& THER, PHER, HER, XER, YER, ZER, XS , XL, THS , THL, PHS , PHL, HS , HL) 

CHECKl = .FALSE. 

W = O.ODO 
DO 82 I =1,NR 

W = W+ DSQRT(ZER(I)**2 + HER(I)**2 + (HS ( 3*1-2 ) *PHER ( I ) ) **2 ) 
82 CONTINUE 

W = W/REAL(NR) 

IF(W.LE.OBJ) THEN 
OBJ = W 
DO 182 1=1,6 
HC = C 

HOLD(l,I) = SHIFT(1,I) 

182 CONTINUE 

BAD = 0 
ELSE 

BAD = BAD + 1 
ENDIF 

IF(BAD.GT.B) GOTO 444 
ENDIF 

TUNE = (C+1.0)/6.0 
IF(C.GE.15) TUNE = 3 . ODO 
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o * * o * * o * 



— — 

LOOK FOR CONSISTENT Y CORRECTIONS 



CALL FIND(YER,NR,MI,MA) 

IF(MA.LT.O .OR. MI.GT.O)THEN 
SUM =0.0 
DO 63 I =1,NR 

SUM = SUM + YER(I)/(REAL(NR) ) 

63 CONTINUE 

TUNEl = TUNE 

SHIFT(1,2) = SHIFT(1,2) + SUM*TUNEl 
CALL NEWERR ( C , TIME , J , LINKS , SENSR , ERROR , SHIFT , DVP , EXT , NR , ORIGIN , 

£ THER , PHER , HER , XER , YER , ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

CHECKl = .TRUE. 

W = O.ODO 
DO 83 I =1,NR 

W = W+ DSQRT(ZER(I)**2 + HER(I)**2 + ( HS ( 3 *1-2 ) *PHER ( I ) ) * *2 ) 
83 CONTINUE 

W = W/REAL(NR) 

GOTO 222 
ENDIF 



LOOK FOR CONSISTENT X CORRECTIONS 



CALL FIND (XER, NR, MI, MA) 

IF(MA.LT.O .OR. MI.GT.0)THEN 
SUM = 0.0 
DO 64 I =1,NR 

SUM = SUM + XER(I)/(REAL(NR) ) 

64 CONTINUE 

TUNE2 = TUNE 

SHIFT(1,1) = SHIFT(1,1) + SUM * TUNE2 
CALL NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 

& THER , PHER , HER , XER , YER , ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

CHECKl = .TRUE. 

W = O.ODO 
DO 84 I =1,NR 

W = W+ DSQRT(ZER(I) **2 + HER(I)**2 + ( HS ( 3*1-2 ) *PHER ( I ) ) * *2 ) 
84 CONTINUE 

W = W/REAL(NR) 

GOTO 222 
ENDIF 



LOOK FOR CONSISTENT Z CORRECTIONS 



CALL FIND(ZER,NR,MI,MA) 

IF(MA.LT.O .OR. MI.GT.0)THEN 
SUM =0.0 
DO 65 I =1,NR 

SUM = SUM + ZER(I ) / (REAL(NR) ) 

65 CONTINUE 

TUNE3 = TUNE* 1.5 

SHIFT(1,3) = SHIFT(1,3) + SUM * TUNE3 
CALL NEWERR ( C , TIME , J , LINKS , SENSR , ERROR , SHIFT , DVP , EXT , NR , ORIG IN , 

& THER , PHER , HER , XER , YER , ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

CHECKl = .TRUE. 

W = O.ODO 
DO 85 I =1,NR 

W = W+ DSQRT(ZER(I)**2 + HER(I)**2 + ( HS ( 3* I -2 ) *PHER ( I ) ) * *2 ) 
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* o 



85 CONTINUE 

W = W/REAL(NR) 
GOTO 222 
ENDIF 



LOOK FOR Y CORRECTIONS 



SUM = 0.0 
DO 66 I =1,NR 

SUM = SUM + YER(I)/(REAL(NR)) 

66 CONTINUE 

TUNEl = TUNE 

SHIFT(1,2) = SHIFT(1,2) + SUM*TUNE1 
CALL NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP , EXT , NR, ORIGIN , 

& THER , PHER , HER, XER, YER, ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

W = O.ODO 
DO 86 I =1,NR 

W = W+ DSQRT(ZER(I)**2 + HER(I)**2 + ( HS ( 3 * 1-2 ) *PHER ( I ) ) * *2 ) 
86 CONTINUE 

W = W/REAL(NR) 



C 



LOOK FOR X CORRECTIONS 



SUM = 0.0 
DO 67 I =1,NR 

SUM = SUM + XER(I)/(REAL(NR) ) 

67 CONTINUE 

TUNE 2 = TUNE 

SHIFT(1,1) = SHIFT(1,1) + SUM * TUNE2 
CALL NEWERR(C,TIME,J, LINKS, SENSR, ERROR, SHIFT, DVP , EXT , NR, ORIGIN , 

& THER, PHER, HER, XER, YER, ZER, XS , XL, THS , THL , PHS , PHL , HS , HL ) 

W = O.ODO 
DO 87 I =1,NR 

W = W+ DSQRT(ZER(I)**2 + HER(I)**2 + ( HS ( 3 * 1-2 ) *PHER ( I ) ) **2 ) 
87 CONTINUE 

W = W/REAL(NR) 



C LOOK FOR Z CORRECTIONS 



SUM = 0.0 
DO 68 I =1,NR 

SUM = SUM + ZER(I)/(REAL(NR) ) 

68 CONTINUE 

TUNE3 = TUNE 

SHIFT (1,3) = SHIFT (1,3) + SUM * TUNE3 
CALL NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 

& THER , PHER , HER , XER , YER , Z ER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

CHECKl = .TRUE. 

W = O.ODO 
DO 88 I =1,NR 

W = W+ DSQRT(ZER(I)**2 + HER(I)**2 + (HS ( 3*1-2 ) *PHER( I ) ) **2 ) 
88 CONTINUE 

W = W/REAL(NR) 

C = C + 1 

IF(C.LT.60 .AND. BAD . LE . 5 ) GOTO 222 

444 WRITE(92,*) 

WRITE ( 92, *) 'C ,C, 'BAD' , BAD 
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WRITE (92, 500) SHIFT (1,1) , SHIFT (1,2) ,SHIFT(1,3) 
WRITE(92, 501)SHIFT(1,4) , SHIFT (1,5) ,SHIFT(1,6) 
WRITE(92,*) HC 

WRITE (92, 502) HOLD (1,1) , HOLD (1,2) , HOLD ( 1 , 3 ) 
WRITE (92,503) HOLD (1,4), HOLD (1,5), HOLD (1,6) 

DO 555 1=1,6 

SHIFT(1,I) = HOLD (1,1) 



555 

500 


CONTINUE 
FORMAT (lOX, 


■PSll 


' ,2X,F9.5,2X, 'PS12 


’ ,F9.5,2X, 


'PS13 


’ ,F9.5) 


501 


FORMAT (lOX, 


'ASH 


■ ,2X,F9.5,2X, 'AS12 


’ ,F9.5,2X, 


'AS13 


• ,F9.5) 


502 


FORMAT (lOX, 


'HSll 


■ ,2X,F9.5,2X, 'HS12 


’ ,F9.5,2X, 


'HS13 


• ,F9.5) 


503 


FORMAT (1 OX, 


'HSll 


■ ,2X,F9.5,2X, 'HS12 


’ ,F9.5,2X, 


'HS13 


’ ,F9.5) 



RETURN 

END 



SUBROUTINE ANNEAL (TIME , J , LINKS , SENSR, DVP , EXT , NR, ORIGIN , XS , XL , THS , 
Sc THL, PHS, PHL, HS, HL, SHIFT , ERROR, WMIN ) 



THIS SUBROUTINE IS THE ARRAY POSITION (SHIFT 1,2,3) AND ORIENTATION 
(SHIFT 4,5,6) CORRECTION ALOGRITHM, MINIMIZING SBL AND LBL POSLOCS 
USING SIMULATED ANNEALING. 



SBL POSLOCS 
LBL POSLOCS 

SBL ELEVATION ANGLES FROM C PHONE 
LBL ELEVATION ANGLES FROM C PHONE 
SBL AZIMUTHS 
LBL AZIMUTHS 

SBL HORIZONTAL DISTANCES FROM C PHONE 
LBL HORIZONTAL DISTANCES FROM C PHONE 
CORRECTIONS APPLIED TO CENTER ARRAY A.C. PREVIOUSLY 
X,Y,Z ARE THE 1,2,3 ELEMENTS ; 4 , 5 , 6 IDENTIFY THE TILTS 
(XTILT, YTILT, ZROT) 

ERROR: THE INDUCED ERRORS TO THE SENSOR POSITIONS (GIVING 

OPERATIONAL POSITIONS) FIRST INDEX CORRESPONDS TO SENSR(I) 
THE SECOND TO THE TYPE ( X , Y , Z , XTILT , YTILT , ZROT ) 

WMIN : INITIAL GUESS TO THE MINIMUM OBJECTIVE FUNCTION VALUE 
TIME, J, LINKS, SENSR, DVP, EXT, NR, ORIGIN : SENSOR ARRAY DATA 
RECEIVED FROM FORTRAN PROGRAM CONTROL 



INPUTS: 

xs 

XL 

THS 

THL 

PHS 

PHL 

HS 

HL 

SHIFT 



OUTPUTS: 

SHIFT: X,Y,Z MOVEMENT (FEET) TO BE APPLIED TO ARRAY A.C. 

XTILT, YTILT, ZROT CORRECTIONS (RADIANS) TO BE APPLIED 
XS, XL, PHS, PHL, THS, THL : UPDATED VALUES OF THESE VECTORS 

J.A. GEMBARSKI 
NPS 03/01/92 



DIMENSION XS(18,3) ,XL(6,3) , THS (18) , THL (18) , PHS (18) 






& PHL(18) ,HS(18) ,HL(18) ,SHIFT(7, 6) ,SENSR(7) ,SMHOLD(7 ) , 

& THER(6) ,PHER(6) , HER( 6 ) , XER( 6 ) , YER ( 6 ) ,ZER(6) ,CPH(7,3) , 

& XPH(7,3) , YPH{7,3) , ZPH(7, 3) , TIME (18, 4) , J ( 6 ) , LINKS ( 18 ) , 

& L(300) ,VEL(300) ,V0(300) ,V1(300) ,DZ(300) ,LM(300) , 

& ORIGIN(6,3) ,ERROR(7, 6) ,X{3) ,A{3) , HOLD (7, 6) ,Y(6) ,U{6) 

COMMON /SETl/ L, VEL, VO, VI ,DZ , LM, M 



DOUBLE PRECISION XS, XL, THS, THL, PHS , PHL, HS, HL, TIME , SHIFT, 
PHER , THER , HER , XER , YER , ZER , SUM , L , VEL , VO , VI , DZ , LM , 
ORIGIN, X, A, CPH,XPH,YPH, ZPH, EPS, ERROR, SMALL , SMHOLD , 
HOLD , W, B , DELRl ,G,WMIN,W0,W1,U,PI,P, DELR2 , ALPHA , DEL 
REAL V,Y 



INTEGER J,LINKS, SENSR,NR,EXT, I,M,DVP,C, BAD, IX,NO,BADl 



LOGICAL CHECK1,CHECK2, JUMPlOO, JUMP200 



PARAMETER DEFINITION 

IX SEED FOR THE RANDOM NUMBER GENERATORS 

BAD NUMBER OF SELECTED ’WRONG’ STEPS MADE 

BADl NUMBER OF STEPS TRIED WITHOUT IMPROVING ON THE SMALLEST 
OBJECTIVE FUNCTION FOUND SO FAR 
ALPHA USED IN DETERMINING A NEW OBJECTIVE FUNCTION VALUE IF 
WMIN EQUALED OF SURPASSED 

B MULTIPLIER FOR DETERMINATION OF PROBABILITY OF ACCEPTING 

’WRONG' STEP 

G EXPONENT FOR INCREMENTAL OBJECTIVE FUNCTION CHANGE FOR 

DETERMINATION OF PROBABILITY OF ACCEPTING ’WRONG’ STEP 
DELRl MULTIPLIER FOR POSITIONAL STEP SIZE 
DELR2 MULTIPLIER FOR ANGULAR STEP SIZE 

NO = 6 

PI = DACOS(-l.ODO) 

EPS = l.OD-4 
BAD = 0 
BADl = 0 
IX = 16806 
JUMPlOO = .FALSE. 

JUMP200 = .FALSE. 

ALPHA = 0.4D0 
B = NR*2.5 + ABS(NR-3) 

DELRl = O.OllDO 
DELR2 = 7.7D-6 
G = l.ODO 
WMIN = O.ODO 
C = 0 



UPDATE POSITIONS OF C PHONES FROM PREVIOUS SHIFTS 

CALL UPDATE ( SENSR, DVP, EXT, SHIFT, ERROR, CPH, XPH, YPH, ZPH, X, A) 

CALL NEWERR (C, TIME, J, LINKS ,'SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 

& THER , PHER , HER , XER , YER , ZER, XS , XL , THS , THL , PHS , PHL , HS , HL ) 



FORM ERROR ARRAYS 



DO 10 1=1, NR 

THER(I) = THL((3*I)-2) - THS((3*I)-2) 
PHER(I) = PHL((3*I)-2) - PHS((3*I)-2) 



o o 
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HER(I) = HL((3*I)-2) - HS((3*I)-2) 

XER(I) = XL(I,1) - XS( (3*I)-2, 1) 

YER(I) = XL(I,2) - XS( (3*I)-2,2) 

ZER(I) = XL(I,3) - XS{ (3*I)-2,3) 
CONTINUE 

PRINT*, SHIFT ( 1, 1) , SHIFT (1,2) ,SHIFT(1,3) 
PRINT*, SHIFT( 1,4) ,SHIFT(1,5) ,SHIFT(1,6) 



C BUILD HOLD ARRAY 

★ 



DO 9 I = 1,7 
DO 8 K=l,6 

HOLD(I,K) = SHIFT(I,K) 

8 CONTINUE 

9 CONTINUE 



CALCULATE NEW ERRORS TERMS USING A WEIGHTED CONSENSUS POSITION 



C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 



DO 88 I = 1, NR 

IF(DABS(XS(3*I-1,2)-XS(3*I,2) ) .LT.0.01) THEN 

YER(I) = (XS(3*I-1,2)+XS(3*I,2) )/2.0 - XS(3*I-2,2) 

CHECKl = .TRUE. 

ELSE 

CHECKl = .FALSE. 

YER(I) = (XS(3*I-1,2)+XS(3*I,2)+XL(I,2) )/3.0 - XS(3*I-2,2) 
ENDIFC 

IF(DABS(XS(3*I-1, 1)-XS(3*I, 1) ) .LT.0.01) THEN 
CHECK2 = .TRUE. 

XER(I) 

ELSE 

CHECK2 = 



(XS(3*I-1, 1)+XS(3*I, 1) ) /2.0 - XS(3*I-2,1) 
FALSE. 



XER(I) = (XS(3*I-1, 1)+XS(3*I, 1)+XL(I, 1) )/3.0 - XS(3*I-2,1) 
ENDIF 

IF (CHECKl .AND. CHECK2 ) THEN 

HER(I) = DSQRT(XER(I ) **2 + YER(I)**2) 

ENDIF 

IF(DABS(XS(3*I-1,3)-XS(3*I,3) ) .LT.0.01) THEN 

ZER(I) = (XS(3*I-1,3)+XS(3*I,3) )/2.0 - XS(3*I-2,3) 

ELSE 

ZER(I) = (XS(3*I-1,3)+XS(3*I,3)+XL(I,3) )/3.0 - XS(3*I-2,3) 
ENDIF 



88 CONTINUE 
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W = O.ODO 
DO 80 I =1,NR 

W = W+ DSQRT(ZER(I)**2+HER(I)**2+(HS(3*I-2)*PHER(I) )**2) 
CONTINUE 

WO = W/REAL(NR) 



CALCULATE NEW WMIN IF THE OBJECTIVE FUNCTION IS LESS THAN OR EQUAL 
TO THE INITIAL WMIN 



DEL = WO-WMIN 
IF(DEL.LT.O.O) THEN 
WMIN = WO + ALPHA*DEL 
IF(WMIN.LT.O.O) WMIN = 0.0 
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c 



WRITE(91, * ) ‘NEW WMIN',WMIN 
ELSEIF(DEL*LE.EPS .AND. DEL. GT. 0.0) THEN 
GOTO 555 
ENDIF 

SMALL = W0*2.0 



C 



CHOOSE A RANDOM DIRECTION TO WALK 



60 IF(BAD.GT.30) GOTO 555 
PRINT*, ’WO* ,W0 
PRINT*, ’BAD' ,BAD 
CALL LNORM(IX,Y,NO, 1,0) 
SUM = 0.0 



DO 12 I = 1,6 

SUM = SUM + ABS(Y(I) )**2.0D0 

12 CONTINUE 

DO 13 1=1,6 

U(I) = Y(I) /SQRT(SUM) 

13 CONTINUE 



14 



24 



DO 14 I = 1,2 
HOLD (1,1) = 
CONTINUE 

HOLD (1,3) = 
DO 24 I = 4,5 
HOLD (1,1) = 
CONTINUE 

HOLD (1,6) = 



SHIFT(1, I) 
SHIFT(1, 3) 
SHIFT(1,I) 
SHIFT( 1, 6) 



+ DELR1*U(I) 

+ 1. 5*DELR1*U(3) 
+ DELR2*U(I) 

+ 0. 5*DELR2*U(6) 



C CHECK FOR VALID STEPS 



IF(HOLD(l,4) .LT. (-PI/2.0) .OR. HOLD ( 1 , 4 ) . GT . ( PI /2 . 0 ) ) GOTO 60 
IF(HOLD(l, 5) .LT. (-PI/2.0) .OR. HOLD ( 1 , 5 ) . GT . ( PI /2 . 0 ) ) GOTO 60 
IF(HOLD(l,6) .LT. (-PI) .OR. HOLD ( 1 , 6 ) . GT . ( PI ) ) GOTO 60 

CALL NEWERR ( C, TIME , J , LINKS , SENSR, ERROR, HOLD , DVP , EXT , NR, ORIGIN , 

& THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS , PHL, HS , HL) 



C CALCULATE NEW ERRORS TERMS USING A WEIGHTED CONSENSUS POSITION 



C DO 89 I = 1, NR 

C IF(DABS(XS(3*I-1,2)-XS(3*I,2) ) .LT.0.01) THEN 

C CHECKl = .TRUE. 

C YER(I) = (XS(3*I-1,2)+XS(3*I,2) )/2.0 - XS(3*I-2,2) 

C ELSE 

C CHECKl = .FALSE. 

C YER(I) = (XS(3*I-1,2)+XS(3*I,2)+XL(I,2) )/3.0 - XS(3*I-2,2) 

C ENDIF 



C 

c 

c 

c 

c 

c 



IF(DABS(XS(3*I-1, 1)-XS(3*I, 1) ) .LT.0.01) THEN 
CHECK2 = .TRUE. 

XER(I) = (XS(3*I-1,1)+XS(3*I,1) )/2.0 - XS(3*I-2,1) 

ELSE 

CHECK2 = .FALSE. 

XER(I) = (XS(3*I-1, 1)+XS(3*I, 1)+XL(I, 1) )/3.0 - XS(3*I-2,1) 
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* o n 



C ENDIF 

C IF(CHECK1 .AND. CHECK2 ) THEN 

C HER(I) = DSQRT(XER{I)**2 + YER(I)**2) 

C ENDIF 

C IF(DABS(XS(3*I-1,3)-XS(3*I,3) ) .LT.0.01) THEN 

C ZER(I) = (XS(3*I-1,3)+XS(3*I,3) )/2.0 - XS(3*I-2,3) 

C ELSE 

C ZER(I) = (XS(3*I-1,3)+XS(3*I,3)+XL(I,3) )/3.0 - XS(3*I-2,3) 

C ENDIF 

C 89 CONTINUE 



CHANGE THE STEP SIZING AND PROBABILITY CALCULATING PARAMETERS IF 
NOT IMPROVING THE OBJECTIVE FUNCTION 



W = O.ODO 
DO 15 I =1,NR 

W = W+ DSQRT(ZER(I ) **2 + HER(I)**2 + (HS ( 3 * 1-2 ) *PHER ( I ) ) * *2 ) 
15 CONTINUE 

W1 = W/REAL(NR) 

DELW = W1 - WO 

IF { WO. LE. SMALL .OR. Wl.LE. SMALL) THEN 
BADl = 0 

IF(JUMP100 .AND. .NOT. JUMP200) THEN 
DELRl = DELRl/1.5 
DELR2 = DELR2/1.5 
JUMPlOO = .FALSE. 

ENDIF 

IF(JUMP100 .AND. JUMP200) THEN 
B = B/1.25 
JUMPlOO = .FALSE. 

JUMP200 = .FALSE. 

ENDIF 

IF(WO.LE.Wl) THEN 
DO 18 1=1, NR 

SMHOLD(I) = SHIFT(1,I) 

18 CONTINUE 
SMALL = WO 

ELSE 

DO 19 1=1, NR 

SMHOLD(I) = HOLD (1,1) 

19 CONTINUE 
SMALL = W1 

ENDIF 

ELSE 

BADl = BADl + 1 
ENDIF 

IF(BADl.EQ.lOO) THEN 
DELRl = DELRl* 1.5 
DELR2 = DELR2*1.5 
JUMPlOO = .TRUE. 

PRINT*, 'JUMPlOO* 

ELSEIF(BAD1.EQ.200) THEN 
B = B*1.25 
JUMP200 = .TRUE. 

PRINT*, ' JUMP200* 

ENDIF 
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IF(BAD1 .EQ. 2500) GOTO 555 



C 



16 



C 

C 

c 

17 

555 

20 



DETERMINE WHETHER OR NOT TO TAKE THE STEP 



IF(Wl.LE.WO) THEN 

DO 16 I = 1,6 

SHIFT (1,1) = HOLD (1,1) 
CONTINUE 



WO = W1 

DEL = WO-WMIN 
IF(DEL.LT.O.O) THEN 

WMIN = WO + ALPHA*DEL 
IF(WMIN.LT.O.O) WMIN = 0.0 
ELSEIF (DEL.LE.EPS .AND. DEL. GT. 0.0) THEN 
GOTO 555 
ENDIF 

C = C + 1 
BAD = 0 
GOTO 60 



ELSE 

BAD = BAD +1 
G = 1.0 - 2.0*W0 

IF( (-B*DELW/ (W0**G) ) .LT.-50.0) THEN 
P = 0.0 
ELSE 

P = EXP(-B*DELW/ (W0**G) ) 

ENDIF 

CALL LRND(IX,V, 1,1,0) 

IF(V.GE.P) THEN 

WRITE(91,*) 'TAKE BAD STEP’ 

C = C + 1 
GOTO 60 
ELSE 

WRITE(91, *) 'TAKE BAD STEP’ 

DO 17 I = 1,6 

SHIFT (1,1) = HOLD(l,I) 

CONTINUE 
WO = W1 
GOTO 60 
ENDIF 

ENDIF 

IF(BAD1.EQ.2500) THEN 
DO 20 I =1,NR 

SHIFT (1,1) = SMHOLD(I) 

CONTINUE 

ENDIF 

WRITE(92, *) ’C’ ,C, ’ BADl ’,BAD1 
WRITE ( 92, *) 

WRITE (92, 500) SHIFT (1,1) , SHIFT (1,2) ,SHIFT(1,3) 
WRITE (92, 501) SHIFT (1,4) , SHIFT (1,5) , SHIFT (1,6) 
WRITE(92,*) 
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WRITE (92,*) 'SMALLEST SMALL 

WRITE (92,500) SMHOLD ( 1 ) , SMHOLD ( 2 ) , SMHOLD ( 3 ) 

WRITE ( 92 , 501 ) SMHOLD ( 4 ) , SMHOLD ( 5 ) , SMHOLD ( 6 ) 

500 FORMAT (lOX, 'PSll ' , 2X, F9 . 5, 2X, ’ PS12 ' , F9 . 5 , 2X , ' PS13 ' , F9 . 5 ) 

501 FORMAT (lOX, 'ASH ’ , 2X, F9 . 5 , 2X , ’ AS12 ' , F9 . 5 , 2X , ' AS13 ' , F9 . 5 ) 

RETURN 

END 



SUBROUTINE NEWTILT ( SENSR , DVP , EXT , PHL , THL , PHS , THS , NR , SHI FT , ERX , 
& ERY, ERROR) 



* SUBROUTINE TO ERRFIX 

* FIND NEW POSITIONS OF THE X AND Y HYDROPHONES BASED ON TWO 

* TILT ERRORS, THOSE CLOSEST TO THE Y AND X AXIS, THIS IS DONE 

* BY FITTING A PLANE THROUGH THE NEW POINTS ALONG THE CHOSEN 

* AZIMUTHS AND THEN BACKING OUT THE X,Y HYDROPHONE POSITIONS 



* INPUTS: 

* ERROR : ERROR ARRAY CONTAINING INDUCED ERRORS TO THE CENTER AND 

* SATELLITE SENSORS-FIRST ELEMENT CONTROLS WHICH SENSOR 

* THE SECOND CONTROLS CORRECTION (1-3; X,Y,Z 4-6; X,Y,Z 

* TILTS) 

* SHIFT : ARRAY CONTAINING CORRECTIONS TO THE CENTER AND 

* SATELLITE SENSORS-FIRST ELEMENT CONTROLS WHICH SENSOR 

* THE SECOND CONTROLS CORRECTION (1-3; X,Y,Z 4-6; X,Y,Z 

* TILTS) 

* SENSR : VECTOR DEFINING SENSOR ARRAY NUMBERS 

* DVP, EXT: DVP IDENTIFIER (FROM CONTROL PROGRAM) AND EXTRAPOLATION 

* CONTROL 

* PHL, PHS, THL, THS : LBL AND SBL POSLOC INFORMATION 

* NR : NUMBER OF OVERLAP REGIONS FOR THE INTERIOR ARRAY OF 

* INTEREST 

* OUTPUTS: 

* ERX : CORRECTION TERM FOR XTILT ANGLE (RADIANS) 

* ERY : CORRECTION TERM FOR YTILT ANGLE (RADIANS) 



DIMENSION PHL (18) ,SHIFT(7,6) , X ( 3 ) , Y ( 3 ) , THL ( 18 ) , 

& CO ( 3 ) , XPH (7,3), YPH (7,3), ZPH (7,3), CPH (7,3), PHS ( 18 ) , 

& THS (18) , ERROR (7, 6) ,SENSR(7) ,PHER(6) 

DOUBLE PRECISION PHL , PI , ZROT, R, HOLD90 , SHIFT , HOLDO , D , ERX , 

& CO, XPH, YPH, ZPH,CPH,X,Y, YTILTL,XTILTL,A,B,C,E,ERY, 
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j?» e» 



XHX , YHX , ZHX , XHY , YHX , ZHY , THL , PHS , THS , XTILTS , 
YTILTS, ERROR, PHER,MA, MI 
INTEGER MARK90, I ,NR,MARKO,EXT,SENSR,DVP,K 

CALL UPDATE ( SENSR , DVP , EXT .SHIFT , ERROR , CPH , XPH , YPH , ZPH , X , Y ) 
ZROT = Y(3) 

D = 30. ODD 

PI = DACOS(-l.ODO) 

MARK90 = 0 
HOLD90 = 5.0*PI/6.0 
MARKO = 0 
HOLDO = 5.0*PI/6.0 



C FIND POSLOC REGIONS CLOSEST TO 0 AND 90 DEGREES (RANGE) 



DO 10 1=1, NR 

IF (DABS ( PHL (3*1-2 ) +ZROT) . LE . PI ) THEN 
R = PHL (3*1-2) + ZROT 
ELSEIF ( ZROT . GT . 0 . 0 ) THEN 

R = PHL(3*I-2) + ZROT - 2.0*PI 
ELSE 

R = 2.0*PI + PHL(3*I-2) + ZROT 
ENDIF 

IF(DABS(R-PI/2.0) .LT.HOLD90)THEN 
HOLD90 = DABS(R-PI/2.0) 

MARK90 = I 
ENDIF 

IF ( DABS (R) .LT. HOLDO) THEN 
HOLDO = DABS(R) 

MARKO = I 
ENDIF 

10 CONTINUE 

IF (MARK90.EQ. MARKO .AND. NR.GT.1)THEN 
IF( (NR-MARK90) .GT.0)THEN 
MARKO = MARK90 + 1 
ELSE 

MARKO = MARK90 - 1 
ENDIF 

ELSEIF ( NR. EQ. 1) THEN 

PRINT*, 'NOT ENOUGH REGIONS TO FORM A PLANE’ 
PRINT*, 'RETURN FROM NEWTILT' 

RETURN 

ENDIF 

IF ( MARK90 . EQ . 0 ) THEN 

PRINT* , 'ERROR IN Y AXIS LOCATION’ 

STOP 

ELSEIF (MARKO. EQ.O) THEN 

PRINT*, 'ERROR IN X AXIS LOCATION’ 

STOP 

ENDIF 

DO 12 1=1,3 

C0(I) = CPH (1,1) 

12 CONTINUE 

FORM THE PLANE THROUGH THE LBL ANGLES 
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* 



X(l) 

X(2) 

X(3) 

Y(l) 

Y(2) 

Y(3) 



D*DCOS(PHL(3*MARK90-2) ) 
D*DSIN(PHL(3*MARK90-2) ) 
-D*DTAN(THL(3*MARK90-2) ) 
D*DCOS(PHL(3*MARKO -2)) 
D*DSIN(PHL(3*MARK0 -2)) 
-D*DTAN(THL(3*MARK0 -2)) 



+ C0(1) 
+ C0(2) 
+ C0(3) 
+ CO ( 1 ) 
+ CO(2) 
+ CO(3) 



CALL PLANE(X,Y,CO,A,B,C,E) 



XHX = D*DCOS (-ZROT) + CO(l) 

YHX = D*DSIN(-ZROT) + CO(2) 

ZHX = CO (3) - (-E-A*XHX-B*YHX) /C 
XTILTL = DASIN(ZHX/D) 

XHY = D*DCOS(-ZROT+PI/2.0) + CO ( 1 ) 
YHY = D*DSIN(-ZROT+PI/2.0) + CO(2) 
ZHY = CO (3) - <-E-A*XHY-B*YHY) /C 
YTILTL = DASIN(ZHY/D) 



FORM THE PLANE THROUGH THE SBL ANGLES 

X(l) = D*DCOS(PHS(3*MARK90-2) ) + CO ( 1 ) 
X(2) = D*DSIN(PHS(3*MARK90-2) ) + CO ( 2 ) 
X(3) = -D*DTAN(THS(3*MARK90-2) ) + CO ( 3 ) 
Y(l) = D*DCOS(PHS(3*MARKO -2)) + CO ( 1 ) 
Y(2) = D*DSIN(PHS(3»MARK0 -2)) + CO(2) 
Y(3) = -D*DTAN(THS(3*MARK0 -2)) + CO ( 3 ) 

CALL PLANE(X, Y,CO,A,B,C,E) 

XHX = D*DCOS (-ZROT) + CO ( 1 ) 

YHX = D*DSIN(-ZROT) + C0(2) 

ZHX = CO (3) - (-E-A*XHX-B*YHX)/C 
XTILTS = DASIN(ZHX/D) 

XHY = D*DCOS(-ZROT+PI/2.0) + CO ( 1 ) 

YHY = D*DSIN(-ZROT+PI/2.0) + CO ( 2 ) 

ZHY = C0(3) - (-E-A*XHY-B*YHY)/C 
YTILTS = DASIN(ZHY/D) 



ERX = (XTILTL-XTILTS) 
ERY = (YTILTL-YTILTS) 

RETURN 

END 
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SUBROUTINE NEWERR(C, TIKE, J, LINKS , SENSR, ERROR, SHIFT, DVP, EXT, NR, 

& ORIGIN, THER,PHER, HER, XER,YER, ZER, XS , XL , THS , THL , 

& PHS,PHL,HS,HL) 



THIS SUBROUTINE PERFORMS A SENSOR SHIFT FROM THE SHIFT ARRAY 
INFORMATION AND THEN CALCULATES A NEW LONGBASE POSLOC AND ERROR 
TABLE. CALLED FROM ERRFIX. 

INPUTS: 

C : OUTPUT CONTROL NUMBER, NUMBER OF ITERATIONS THROUGH 

ERRFIX SUBROUTINE 

ERROR : ERROR ARRAY CONTAINING INDUCED ERRORS TO THE CENTER AND 
SATELLITE SENSORS-FIRST ELEMENT CONTROLS WHICH SENSOR 
THE SECOND CONTROLS CORRECTION (1-3; X,Y,Z 4-6; X,Y,Z 
TILTS) 

SHIFT : ARRAY CONTAINING CORRECTIONS TO THE CENTER AND 

SATELLITE SENSORS-FIRST ELEMENT CONTROLS WHICH SENSOR 
THE SECOND CONTROLS CORRECTION (1-3; X,Y,Z 4-6; X,Y,Z 
TILTS) 

TIME, LINKS, SENSR, J: INDIVIDUAL ARRAY VECTORS AS DEFINED IN\ 

SUBROUTINE SETUP FOR THE NANOOSE RANGE 

DVP,EXT: DVP IDENTIFIER (FROM CONTROL PROGRAM) AND EXTRAPOLATION 
CONTROL 

TRUE TARGET POSITION, USED FOR COMPARATIVE ANALYSIS 



ORIGIN 

OUTPUTS: 

THER 

PHER 

HER 

XER 

YER 

ZER 



ELEVATION ANGLE ERROR (LBL - SBL) 
AZIMUTH ANGLE ERROR (LBL - SBL) 
HORIZONTAL RANGE ERROR (LBL - SBL) 
X COORDINATE ERROR (LBL - SBL) 

Y COORDINATE ERROR (LBL - SBL) 

Z COORDINATE ERROR (LBL - SBL) 



UPDATED VALUES FOR XS , XL , PHS , PHL , THS , THL , HS , HL 



J.A. GEMBARSKI 
NPS 01/01/92 



DIMENSION CPH(7,3) ,THER(6) ,PHER(6) ,HER(6) ,XER(6) , 

& YER( 6) , ZER(6) , A ( 3 ) , X ( 3 ) , XS ( 18 , 3 ) , XL ( 6 , 3 ) , 

& THS ( 18 ) , THL ( 18 ) , PHS ( 18 ) , PHL ( 18 ) , HS ( 18 ) , HL ( 18 ) , 

Sc NEW(3) ,ORIGIN(6,3) , SHIFT (7, 6) ,ERROR(7,6) ,SENSR(7) , 

Sc XPH(7,3) ,YPH(7,3) ,ZPH(7,3) , TIME (18, 4) , J(6) , LINKS (18) 



DOUBLE 

DOUBLE 

DOUBLE 

DOUBLE 

INTEGER 



PRECISION CPH, THER, PHER, HER, XER, YER, ZER, A, X, XS 

PRECISION XPH, YPH, ZPH 

PRECISION XL, THS , THL, ORIGIN , SHIFT, ERROR 

PRECISION PHS, PHL, HS, HL, TIME , NEW 

K , J , LINKS , SENSR , NR, EXT , DVP , C 



CALL UPDATE ( SENSR , DVP , EXT , SHI FT , ERROR , CPH , XPH , YPH , ZPH , X , A ) 

K =1 

DO 10 I=1,3*NR,3 

CALL SHIFTER(X(3) ,A(1),A(2),A(3) , TIME , I , NEW, HS ( I ) , THS ( I ) ) 

XS(I,1) = CPH(LINKS(I) ,1) + NEW(l) 

XS(I,2) = CPH(LINKS(I ) ,2) + NEW(2) 

XS(I,3) = NEW(3) 

C WRITE (3,*) ’LONG FROM NEWERR ’ 
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CALL LONG (TIME , LINKS , SENSR , CPH , K , XS , HS , THS , THL , PHS , PHL , 
Sc HL,XL) 



C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 



C 

C 

C 

C 

C 

C 

C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 
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230 

231 

232 

233 

234 

235 

236 

237 

238 

239 

240 

250 

251 

252 

253 

254 

255 



THER(K) = 
PHER(K) = 
HER(K) = 
XER(K) = 
YER(K) = 
ZER(K) = 
IF(C,GT. 16)THEN 
WRITE(91, *) 
WRITE(91, 230) 
N = (3*K)-2 
WRITE(91, 231) 
WRITE(91,232) 
WRITE(91,233) 
WRITE (91, 234) 
WRITE(91,235) 
WRITE(91,236) 
WRITE(91,237) 
WRITE(91,238) 
WRITE(91,239 ) 
WRITE(91,240) 
ENDIF 

K = K + 1 
CONTINUE 

IF(C.GT.14) THEN 
WRITE (91, * ) 
WRITE(91,250) 
WRITE(91,251) 
WRITE(91, *) 
WRITE(91,252) 
WRITE (91,*) 
WRITE(91,253) 
WRITE (91, * ) 
WRITE(91,254) 
WRITE(91, * ) 
WRITE(91,255) 
WRITE (91, *) 
WRITE(91,256) 
WRITE(91,*) 
WRITE(91,257) 
ENDIF 



THL(I) - THS(I) 
PHL(I) - PHS(I) 



HL(I) - 
XL(K, 1) 
XL(K,2) 
XL(K,3) 



J(K) 



HS(I) 

- XS(I,1) 

- XS(I,2) 

- XS(I,3) 



( SENSR ( LINKS (MP) ) ,MP=N,N+2) 

XS(N, 1) ,XS(N+1, 1 ) ,XS(N+2, 1) , XL(K, 1 ) , ORIGIN (K, 1) 
XS(N,2) ,XS(N+1,2) ,XS(N+2,2) ,XL(K,2) , ORIGIN (K, 2) 
XS(N,3) ,XS(N+1,3) ,XS(N+2,3) ,XL(K,3) ,ORIGIN(K,3) 
THS(N) ,THS(N+1) ,THS(N+2) 

THL(N) ,THL(N+1) ,THL(N+2 ) 

PHS(N) ,PHS(N+1) ,PHS(N+2) 

PHL(N) ,PHL(N+1) ,PHL(N+2) 

HS(N) ,HS(N+1) ,HS(N+2) 

HL(N) ,HL(N+1) ,HL(N+2) 



( J(MP) ,MP=1,NR) 
(THER(MP) ,MP=1,NR) 
(PHER(MP) ,MP=1,NR) 
(HER(MP) ,MP=1,NR) 
(XER(MP) ,MP=1,NR) 
(YER(MP) ,MP=1,NR) 
(ZER(MP) ,MP=1,NR) 



RETURN 

FORMAT (25X, 'REGION ’ , 12) 

FORMAT(2X,3(3X, 'ARRAY' , IX, 12, IX, ' SBL ’ ) , 3X, ' LONGBASE * ,6X, 'GOAL' ) 
FORMAT ( IX, 'X' ,4X,F9.2, 2 (7X,F9.2) , 5X, F9.2, 3X,F9,2) 

FORMAT (IX, 'Y' ,4X,F9.2,2(7X,F9.2) ,5X,F9,2,3X,F9,2) 

FORMAT (IX, 'Z' ,4X,F9.2,2(7X,F9.2) ,5X,F9.2,3X,F9.2) 

FORMAT (IX, 'THS' , 3X , F8 . 5 , 2 ( 8X , F8 • 5 ) , 5X , F8 . 4 , 3X , F8 . 4 ) 

FORMAT (IX, 'THL' , 3X , F8 . 5 , 2 ( 8X , F8 . 5 ) , 5X , F8 . 4 , 3X , F8 . 4 ) 

FORMAT (IX, 'PHS' , 3X , F8 . 5 , 2 ( 8X , F8 . 5 ) , 5X , F8 . 4 , 3X , F8 . 4 ) 

FORMAT (IX, 'PHL' , 3X , F8 . 5 , 2 ( 8X , F8 . 5 ) , 5X , F8 . 4 , 3X , F8 . 4 ) 

FORMAT (IX, 'HS' ,4X,F8.2,2(8X,F8.2) ,5X,F8.2,3X,F8.2) 

FORMAT (IX, 'HL' ,4X,F8.2,2(8X,F8.2) ,5X,F8. 

FORMAT (15X, 'CENTER ARRAY ERROR ANALYSIS' 

FORMAT (IX, 'REGION' , 5X , 12 , 5 ( 8X , 12 ) ) 

FORMAT (IX, 'THER' , 2X , 6 ( 2X , F8 . 5 ) ) 

FORMAT (IX, 'PHER' , 2X , 6 ( 2X , F8 . 5 ) ) 

FORMAT (IX, 'HER' , 3X, 6 ( 2X , F8 • 4 ) ) 

FORMAT (IX, 'XER' , 2X , 6 ( 2X , F8 . 3 ) ) 



,2,3X,F8.2) 

•) 
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256 F0RMAT(1X, ’YER' ,2X,6(2X,F8.3) ) 

257 F0RMAT(1X, 'ZER' ,2X,6(2X,F8.3) ) 
END 
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APPENDIX D: COMPUTER PROGRAM CONTROL 



This is the main driving program of the error correction methodology. 

Additional control lines have been added than are presented in the 
logic flow chart (Figure 11). These control lines were needed during 
multiple sensor array correction attempts. The nature of the control 
structure is to determine the entry into ANNEAL. The entry requirements 
into ANNEAL have also been changed (from objective function value 0.5 to 
1.0). This enabled faster solution convergence by preceding to ANNEAL 
quicker . 



PROGRAM CONTROL 

* 

* THIS PROGRAM CONTROLS THE ERROR CORRECTION SCHEME FOR THE NANOOSE 

* RANGE. 

* A SIMULATION START (SIMSTRT) SUBROUTINE GENERATES TRANSIT TIMES FOR 

* EACH SENSOR IN THE RANGE TO ITS TRIPLE OVERLAP REGIONS R(ANGE)TIME 

* (THIS INFORMATION IS NORMALLY PROVIDED BY THE RANGE). 

* SENSOR OPERATIONAL POSITION (ERROR INDUCED FROM THE ACTUAL POSITION) 

* IS CREATED THROUGH THE RANGE ERROR (RERROR) SUBROUTINE. SENSOR 

* ACTUAL POSITION IS FOUND IN THE SUBROUTINE ARRAY. 

* J.A. GEMBARSKI 

* NPS 03/01/92 



DIMENSION HOLD (6) ,XPHLOC(7,3) ,YPHLOC(7,3) ,ZPHLOC(7,3) , CPHLOC ( 7 , 3 ) , 
& ORIGIN (6, 3) ,XS(18,3) ,XL(6,3) , RLINKS ( 0 : 57 , 18 ) ,J(6) , 

& L(300) ,VEL(300) , VO (300) ,V1(300) ,LM(300) , RORIGIN ( 2 7 , 3 ) , 

& DZ(300) ,SHIFT(7,6) , RSHIFT ( 0 : 57 , 6 ) ,YER(6) ,ZER(6) , 

& THL(18) ,HS(18) ,THER(6) , PHER ( 6 ) ,HER(6) ,XER(6) ,SENSR(7) , 

& THS(18) ,HL(18) ,PHS(18) ,PHL(18) , ERROR (7, 6) , LINKS ( 18 ) , 

Sc RTIME (0:57,2 7,4) , RSENSR ( 0 : 57 , 7 ) ,TIME(18,4) , CHECKA ( 0 : 57 ) , 

Sc RJ(0:57,6) ,RNR(0;57) , RDATA ( 0 : 57 , 27 , 6 ) , ROB J ( 0 : 57 ) , W1 ( 7 ) , 

Sc RERRTAB(0:57,27,6) , RXS ( 0 : 57 , 2 7 , 3 ) ,RXL(27,3) ,MARK(0:57) 

COMMON /SETl/ L, VEL, VO , VI , DZ , LM,M 

INTEGER SENSR, J, ERR, K, NR, H,N,M, LINKS, RJ,RLINKS,RNR, RSENSR, S, 

+ MP,EXT, I,DVP,SS,NRS,MARK,MA 

DOUBLE PRECISION 
DOUBLE PRECISION 
DOUBLE PRECISION 
DOUBLE PRECISION 
DOUBLE PRECISION 

LOGICAL CHECKA, CHECKO,MKANN 



ORIGIN , XS , XL , XPHLOC , YPHLOC , ZPHLOC , CPHLOC , XER 
VO, VI , LM, L, VEL, DZ , RDATA, RERRTAB, THER, YER, ZER 
THL , HOLD , PHER, HER , RORIG IN , RSHI FT , RTIME , ROB J 
TIME, PHS,PHL,HL,HS, THS, SHIFT, ERROR, RXS, RXL,W 
MAX,TOL,WMIN,Wl 



C 



INITIALIZATION 



o o o 



.FALSE 



DO 3 1=1,300 
L(I) = 0.0 
VEL(I) = 0.0 
V0(I) = 0.0 

V1(I ) =0.0 

DZ(I) = 0.0 
LM(I) = 0.0 

IF(I.LE.58) CHECKA(I-l) = 
3 CONTINUE 

DATA THS/18»0/ 

DATA THL/18*0/ 

DATA PHS/18*0/ 

DATA PHL/18*0/ 

DATA HS/18*0/ 

DATA HL/18*0/ 

DATA XS/54*0/ 

DATA XL/18*0/ 

DATA SHIFT/42*0/ 

DATA XPHLOC/21*0/ 

DATA YPHLOC/21*0/ 

DATA ZPHLOC/21*0/ 

DATA CPHLOC/21*0/ 

DATA RSHIFT/348*0/ 

DATA RTIME/6264*0/ 

DATA RDATA/9396*0/ 

DATA RSENSR/406*-!/ 

DATA RORIGIN/81*0/ 

DATA MARK/ 58*0/ 

ERR = 0 
TOL = l.OD-4 
MA = 58 



c 

c 


CHOSE THE DVP TO BE USED 0 

0.02 


ISOSPEED = 10 
ISOGRADIENT = 


11 


c 


0.04 


ISOGRADIENT = 


12 


c 


0.06 


ISOGRADIENT = 


13 


c 


0.08 


ISOGRADIENT = 


14 


c 


0.083 


ISOGRADIENT = 


15 



C REAL WATER COLUMN = 5 

DVP = 10 

C TO CANCEL THE DVP EXTRAPOLATION SET EXT TO 2 
EXT = 2 

OPEN(UNIT=3,FILE=' /long OUT A') 

OPEN(UNIT=44, FILE= ■ /REC METHOD A') 

OPEN(UNIT=90, FILE= ' /info TSTR A') 

OPEN (UNIT=91, FILE= ' /data TSTR T’) 

OPEN(UNIT=92,FILE=' /VALID BIG T’) 

666 CALL SIMSTRT(DVP,EXT,RTIME,RORIGIN) 

CALL SETUP ( DVP , EXT , RTIME , RSHIFT, RSENSR, RLINKS , RJ , RDATA, 

& RERRTAB,RXS,RXL,RNR,ROBJ) 

MKANN = .FALSE. 

999 MAX = O.ODO 

CHECKO = .TRUE. 

DO 40 I = 0,57 

IF(ROBJ(I) .EQ.-l.O) GOTO 40 
IF(ROBJ(I) .GT.5.0D0) PRINT* ,’ CHECK FOR’, I 

IF(ROBJ(I) .GT.1.0 .AND. .NOT. MKANN .AND. RNR(I).EQ.6) THEN 
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PRINT*,* OBJ PREVENTIN ANNEAL M , ROB J ( I ) 

CHECKO = -FALSE. 

ENDIF 

IF(MA.EQ.I) GOTO 40 

IF(ROBJ(I) -GE.MAX -AND. ROB J ( I ) . GT . TOL -AND. ( RNR ( I ) . EQ . 6 ) ) THEN 
S = I 

MAX = ROBJ(I) 

ENDIF 
40 CONTINUE 

PRINT*, *S IN CONTROL *,S 

* 

C RETRIEVE RANGE INFORMATION ARRAYS FROM SETUP SUBROUTINE 

★ 

PRINT*, 'BEFORE ERRFIX/ANNEAL ' 

DO 5 I = 1,7 

SENSR(I) = RSENSR(S,I) 

PRINT*, *OBJ' ,SENSR(I) , ROBJ ( SENSR ( I ) ) 

5 CONTINUE 

DO 4 I =1,18 

LINKS (I) = RLINKS(S,I) 

4 CONTINUE 



C ESTABLISH INDUCED ERRORS FOR THE CENTER AND SATELLITE ARRAYS 
★ 

DO 9 1=1,7 

IF(SENSR(I) -EQ.-l) GOTO 9 
CALL RERROR(SENSR(I) ,HOLD,ERR) 

DO 8 H = 1,6 

ERROR(I,H) = HOLD(H) 

8 CONTINUE 

9 CONTINUE 

★ 

C RETREIVE THE ARRAY SHIFT INFORMATION FOR PREVIOUS SHIFTS 

★ 

DO 7 1=1,7 

IF(SENSR(I) .EQ.-l) GOTO 7 
DO 6 H = 1,6 

SHIFT(I,H) = RSHIFT(SENSR(I) ,H) 

IF(I.EQ.l) J(H) = RJ(S,H) 

6 CONTINUE 

7 CONTINUE 

K = 1 

DO 10 I = 1,18 
DO 11 H = 1,4 

TIME(I,H) = RTIME(SENSR(LINKS(I) ) ,J(K) ,H) 

11 CONTINUE 

IF(MOD(I,3) .EQ.0)K = K+I 
10 CONTINUE 

NR = RNR(S) 



DO 13 I = 1,6 
DO 14 H = 1,3 

ORIGIN(I,H) = RORIGIN(J(I) ,H) 
14 CONTINUE 

13 CONTINUE 
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c 

* 



RETREIVE THE WORKING ARRAYS FROM THE 



RANGE ARRAYS 



20 



K = 


1 


DO 20 I 


= 


THS( 


I) 


THL( 


I) 


PHS( 


I) 


PHL( 


I) 


HS( 


I) 


HL( 


I) 


XS(I, 


1) 


XS(I, 


2) 


XS(I, 


3) 


IF (MOD 



CONTINUE 



1 , 



I, 



18 

RDATA ( SENSR (LINKS ( 
RDATA ( SENSR (LINKS ( 
RDATA ( SENSR ( LINKS ( 
RDATA ( SENSR ( LINKS ( 
RDATA ( SENSR (LINKS ( 
RDATA ( SENSR ( LINKS ( 
RXS(SENSR(LINKS(I) 
RXS ( SENSR ( LINKS ( I ) 
RXS ( SENSR ( LINKS ( I ) 
3) .EQ.O) K = K+1 



I))»J(K), 
I) )/J(K), 
I))/J(K), 
I) ) ,J(K) , 

),J(K),1) 

),J(K),2) 

),J(K),3) 



1 ) 

2 ) 

3 ) 

4 ) 

5 ) 

6 ) 
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DO 21 I = 
THER( I ) 
PHER( I ) 
HER( I ) 
XER( I ) 
YER(I) 
ZER( I ) 
XL(I, 1) 
XL ( I , 2 ) 
XL ( I , 3 ) 
CONTINUE 



1,6 



RERRTAB 


(S, 


,J( 


I) 


,1) 


RERRTAB 


(S, 


,J( 


I) 


,2) 


RERRTAB 


(S, 


,J( 


I) 


,3) 


RERRTAB 


(S, 


,J( 


I) 


,4) 


RERRTAB 


(S, 


'J( 


I) 


,5) 


RERRTAB 


(S, 


'J( 


I) 


,6) 


^ RXL(J( 


I). 


’1) 






= RXL(J( 


I) , 


.2) 






RXL(J( 


I) , 


.3) 







WRITE(92,220) 
WRITE(92,221) 
WRITE(92, 222 ) 
WRITE(92,223) 
WRITE(92,224) 
WRITE(92,225) 
WRITE(92,226) 
WRITE(92,227) 
WRITE (92, 228) 



(SENSR(N) ,N=I, 7) 

( ERROR (N, 1) ,N=1,7) 
(ERR0R(N,2) ,N=1,7) 
( ERROR (N, 3) ,N=1,7) 
( ERROR (N, 4) ,N = 1, 7) 
(ERROR(N, 5) ,N = 1, 7) 
( ERROR (N, 6) ,N = 1, 7) 



DO 77 K = 1,NR 
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WRITE(92, *) 
WRITE(92,230) 
N = (3*K)-2 
WRITE(92,231) 
WRITE(92,232) 
WRITE(92,233) 
WRITE(92,234) 
WRITE(92,235) 
WRITE(92,236) 
WRITE(92, 237) 
WRITE(92, 238) 
WRITE(92,239) 
WRITE(92,240) 
CONTINUE 



J(K) 



(SENSR 


(LINKS(MP) ) 


,MP=N,N+2) 






XS(N, 1 


) ,XS(N+1, 1) 


, XS(N+2 , 


1), 


XL(K, 


1) 


XS(N, 2 


) ,XS(N+1,2) 


,XS(N+2, 


2) , 


XL(K, 


2) 


XS(N,3 


) ,XS(N+1,3) 


,XS(N+2 , 


3), 


XL(K, 


3) 


THS(N) 


,THS(N+1) ,THS(N+2) 








THL(N) 


,THL(N+1) ,THL(N+2 ) 








PHS(N) 


,PHS(N+1) ,PHS(N+2) 








PHL(N) 


, PHL(N+1) , PHL(N+2 ) 








HS(N) , 


HS(N+1) ,HS( 


N+2) 








HL(N) , 


HL(N+1 ) ,HL( 


N+2) 









WRITE (92, *) 

WRITE (92, *) 

WRITE(92,250) 

WRITE(92,251) ( J (MP ) , MP=1 , NR) 



ORIGIN(K, 1) 
ORIGIN(K,2) 
ORIGIN(K,3) 
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WRITE(92,*) 
WRITE (92, 252) 
WRITE (92,*) 
WRITE (92, 253) 
WRITE (92,*) 
WRITE (92, 254) 
WRITE(92,*) 
WRITE(92,255) 
WRITE (92,*) 
WRITE(92, 256) 
WRITE (92 , * ) 
WRITE(92,257) 



( (THL(3*MP-2)-THS(3*MP-2) ) ,MP=1,NR) 
( (PHL(3*MP-2)-PHS(3*MP-2) ) ,MP=1,NR) 
( (HL(3*MP-2 )-HS( 3*MP-2 ) ) ,MP=1,NR) 

( (XL(MP,1)-XS( (3*MP)-2,1) ) ,MP=1,NR) 
( (XL(MP,2)-XS( (3*MP)-2,2) ) ,MP=1,NR) 
( (XL(MP,3)-XS( (3*MP)-2,3) ) ,MP=1,NR) 



DO 19 1=1,6 

HOLD(I) = SHIFT(1,I) 
19 CONTINUE 



C 



ERROR CORRECTIONS 



IF (.NOT. CHECKO) THEN 

CALL ERRFIX ( TIME , J, LINKS , SENSR, DVP, EXT, NR, ORIGIN , XS , XL, THS , THL, 
& PHS,PHL,HS,HL, SHI FT, ERROR) 

ENDIF 

CALL EVAL ( RDATA , RERRTAB , SENSR , L INKS , RNR , RJ , PHS , PHL , HL , HS , 

& XS,XL,W1) 



IF (CHECKO) THEN 

PRINT* ,’ PRE-ANNEAL MARK ’, S , MARK ( S ) 

WMIN = O.ODO 
DO 22 I = 2,7 

IF(SENSR(I ) .EQ.-l .AND. RNR(I).NE.6) GOTO 22 
IF(ROBJ(SENSR(I) ) .GT.WMIN) WMIN = ROB J ( SENSR ( I ) ) 

22 CONTINUE 

WMIN = WMIN/2.0 

PRINT* , ' TO ANNEAL ’ , S , ' WMIN ' , WMIN 

CALL ANNEAL ( TIME , J , LINKS , SENSR , DVP , EXT , NR , ORIGI N , XS , XL , THS , THL , 
& PHS, PHL, HS,HL, SHIFT, ERROR, WMIN) 

MKANN = .TRUE. 

MA = S 

23 ENDIF 



C OUTPUT THE NEW (CORRECTED) POSLOC DATA 

* 



DO 78 K = 1,NR 
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WRITE (92, * ) 
WRITE (92, 230) 
N = (3*K)-2 
WRITE(92,231) 
WRITE (92, 232) 
WRITE (92, 233) 
WRITE (92, 234) 
WRITE (92, 235) 
WRITE(92,236) 
WRITE(92,237) 
WRITE(92,238) 
WRITE (92, 239) 
WRITE (92, 240) 
CONTINUE 



J(K) 

(SENSR(LINKS(MP) ) ,MP=N,N+2) 

XS(N, 1) ,XS(N+1, 1) ,XS(N+2, 1) ,XL(K, 1) , ORIGIN ( K, 1) 
XS(N,2) ,XS(N+1,2) ,XS(N+2,2) ,XL(K,2) ,ORIGIN(K,2) 
XS(N,3) ,XS(N+1,3) ,XS(N+2,3) ,XL(K,3) , ORIGIN (K, 3) 
THS(N) ,THS(N+1) ,THS(N+2) 

THL(N) ,THL(N+1) ,THL(N+2) 

PHS(N) ,PHS(N+1) ,PHS(N+2) 

PHL(N) ,PHL(N+1) ,PHL(N+2) 

HS(N) ,HS(N+1) ,HS(N+2) 

HL(N) ,HL(N+1) ,HL(N+2) 
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WRITE(92, *) 
WRITE (92, * ) 
WRITE (92, 2 50) 
WRITE(92,251) 
WRITE ( 92, *) 
WRITE(92,252) 
WRITE(92, *) 
WRITE (92, 2 53) 
WRITE(92, *) 
WRITE(92,254) 
WRITE(92,*) 
WRITE (92, 255) 
WRITE ( 92, *) 
WRITE(92,256) 
WRITE (92 , * ) 
WRITE (92, 257) 



( J(MP) ,MP=1,NR) 

( (THL(3*MP-2)-THS(3*MP-2) ) ,MP=1,NR) 
( (PHL(3*MP-2)-PHS(3*MP-2) ) ,MP=1,NR) 
( (HL(3*MP-2)-HS(3*MP-2) ) ,MP=1,NR) 

( (XL(MP,1)-XS( (3*MP)-2,1) ) ,MP=1,NR) 
( (XL(MP,2)-XS( (3*MP)-2,2) ) ,MP=1,NR) 
( (XL(MP,3)-XS( (3*MP)-2,3) ) ,MP=1,NR) 



DO 33 I =1,7 

IF(SENSR(I) .EQ.-l) GOTO 33 
DO 34 H =1,6 

RSHIFT(SENSR(I ) ,H) = SHIFT(I,H) 
34 CONTINUE 

33 CONTINUE 



60 



K = 1 

DO 60 I = 1,18 

RDATA(SENSR(LINKS(I) ) , J(K) , 1) = THS(I) 
RDATA(SENSR(LINKS(I) ) , J(K) ,2) = THL(I) 
RDATA(SENSR(LINKS(I) ) ,J(K) ,3) = PHS ( I ) 
RDATA(SENSR(LINKS(I) ) ,J(K) ,4) = PHL(I) 
RDATA(SENSR(LINKS(I) ) ,J(K) ,5) = HS(I) 
RDATA(SENSR(LINKS(I) ) , J(K) ,6) = HL(I) 
RXS(SENSR(LINKS(I) ) ,J(K) ,1) = XS(I,1) 

RXS(SENSR(LINKS(I) ) ,J(K) ,2) = XS ( I , 2 ) 

RXS(SENSR(LINKS(I) ) , J(K) ,3) = XS(I,3) 



,1) = THL(I) - 


THS ( I ) 


,2) = PHL(I) - 


PHS(I) 


,3) = HL(I) - 


HS(I) 


,4) = XL(K,1) 


- XS(I,1) 


,5) = XL(K,2) 


- XS(I,2) 


,6) = XL(K,3) 


- XS(I,3) 



IF(MOD(I,3) .EQ.O) K = K+1 
CONTINUE 



DO 61 K = 1,6 
RXL(J(K) , 1) 
RXL(J(K) ,2) 
RXL( J(K) ,3) 
61 CONTINUE 



XL(K, 1) 
XL(K,2) 
XL(K,3) 



MARK(S) = MARK(S) + 1 
DO 41 K = 1,7 

IF(SENSR(K) .EQ.-l) GOTO 41 
SS = SENSR(K) 

W = O.ODO 

DO 42 I=1,RNR(SS) 

W = W + DSQRT( (RERRTAB(SS,RJ(SS,I) ,6) )**2 + 

& (RERRTAB(SS,RJ(SS, I) ,3) ) **2 + 

& (RDATA(SS,RJ(SS,I),5)»RERRTAB(SS,RJ(SS,I) ,2) )**2) 

42 CONTINUE 
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41 

220 

221 

222 

223 

224 

225 

226 

227 

228 

230 

231 

232 

233 

234 

235 

236 

237 

238 

239 

240 

250 

251 

252 

253 

254 

255 

256 

257 



ROB J ( SS ) = W/REAL ( RNR ( SS ) ) 
PRINT* , * OBJ ' , SS , ROBJ ( SS ) 
CONTINUE 

PRINT*, 'MARK ’,S,MARK(S) 



IF(MARK(S) .LT. 10) GOTO 999 
STOP 

FORMAT (IIX, 'CENTER' ,20X, ' AD JACENTS ' ) 

FORMAT (IX, 'ARRAYS' , 6X, 12 , 9X, 12 , 5 ( 6X, 12 ) ) 

FORMAT(/,lX, 'SHIFTS' ) 

FOPlMAT(3X, 'DELX' , 4X , F8 . 4 , 2X , 6 ( IX , F8 . 4 ) ) 

FORMAT (3X, 'DELY' , 4X , F8 . 4 , 2X , 6 ( IX , F8 • 4 ) ) 

FORMAT (3X, 'DELZ' , 4X , F8 . 4 , 2X , 6 ( IX , F8 . 4 ) ) 

FORMAT (3X, 'DXTILT' , 2X , F8 . 4 , 2X , 6 ( IX , F8 . 4 ) ) 

FORMAT (3X, 'DYTILT' , 2X, F8 . 4 , 2X, 6 ( IX , F8 . 4 ) ) 

FORMAT (3X, 'DZROT' , 3X , F8 . 4 , 2X , 6 ( IX, F8 . 4 ) ) 

FORMAT ( 2 5X, 'REGION ’ , 12) 

FORMAT (2X, 3 (3X, 'ARRAY' , IX, 12, IX, 'SBL ' ) ,3X, ' LONGBASE ' , 6X, 'GOAL' ) 
FORMAT (IX, 'X' ,4X,F9.2,2(7X,F9.2) ,5X,F9.2,3X,F9.2) 

FORMAT (IX, 'Y' ,4X,F9.2,2(7X,F9,2) ,5X,F9.2,3X,F9.2) 

FORMAT (IX, ' Z' ,4X,F9.2,2(7X,F9.2) ,5X,F9.2,3X,F9.2) 

FORMAT (IX, 'THS' , 3X , F8 . 5 , 2 ( 8X , F8 . 5 ) , 5X , F8 . 4 , 3X , F8 • 4 ) 

FORMAT (IX, 'THL' , 3X , F8 • 5 , 2 ( 8X , F8 , 5 ) , 5X , F8 . 4 , 3X , F8 • 4 ) 

FORMAT (IX, 'PHS' , 3X , F8 • 5 , 2 ( 8X , F8 , 5 ) , 5X , F8 . 4 , 3X , F8 . 4 ) 

FORMAT (IX, 'PHL' , 3X , F8 , 5 , 2 ( 8X , F8 . 5 ) , 5X , F8 . 4 , 3X , F8 . 4 ) 

FOR>lAT(lX, 'HS' ,4X,F8.2,2(8X,F8.2) ,5X,F8.2,3X,F8.2) 

FORMAT (IX, 'HL' ,4X,F8.2,2(8X,F8.2) ,5X,F8.2,3X,F8.2) 

FORMAT(15X, 'CENTER ARRAY ERROR ANALYSIS') 

FORMAT (IX, 'REGION' , 5X , I 2 , 5 ( 8X , I 2 ) ) 

FORMAT (IX, 'THER' , 2X , 6 ( 2X , F8 . 5 ) ) 

FORMAT (IX, 'PHER' , 2X , 6 ( 2X , F8 • 5 ) ) 

FORMAT (IX, 'HER' , 3X , 6 ( 2X , F8 . 4 ) ) 

FORMAT (IX, 'XER' , 2 X , 6 ( 2X , F8 . 3 ) ) 

FORMAT (IX, 'YER' , 2 X , 6 ( 2X , F8 . 3 ) ) 

FORMAT (IX, 'ZER' , 2X , 6 ( 2X , F8 , 3 ) ) 

END 
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APPENDIX E: COMPUTER PROGRAMS - GENERAL RANGE AND SYSTEM SUPPORTING 

This appendix contains the following FORTRAN programs: 

UPDATE, FIND, PLANE, RAYFIT ( formal ly RAYFITl ) , ISOGAD (formally ISGRADl), 
ARRAY, FINDOVR, OVERLAP, POINTST, GLOBE, RERROR. 



★ 



★ 



SUBROUTINE UPDATE ( SENSR, DVP , EXT , SHIFT , ERROR , CPH , XPH , YPH , ZPH, 

& PU,AU) 

THIS SUBROUTINE UPDATES THE POSITION OF THE HYDROPHONES FOR THE 
CENTER ARRAY AND ALL OF ITS SATELLITE ARRAYS. POSITIONS ARE 
PROVIDED IN GLOBAL RANGE COORDINATES. 

J.A. GEMBARSKI 
NPS 01/10/92 



* INPUTS: 

* SENSR : 7 ELEMENT ARRAY CONTAINING CENTER (1) AND SATELLITE 

* (2-7) SENSOR NUMBERS 

* EXT : EXTRAPOLATION CONTROL FOR DVP PROFILE 1-EXTRAPOLATE 

* IF NEEDED, 2- DO NOT EXTRAPOLATE 

* SHIFT : ARRAY CONTAINING SHIFTS TO BE PREFORMED ON CENTER AND 

* SATELLITE ARRAYS (FIRST ELEMENT) IN THE X,Y,Z (SECOND 

* ELEMENT, 1-3) AND THE XTILT , YTILT , ZROT (4-6) 

* ERROR : ARRAY CONTAINING ERRORS INDUCED ON CENTER AND 

* SATELLITE ARRAYS (FIRST ELEMENT) IN THE X,Y,Z (SECOND 

* ELEMENT, 1-3) AND THE XTILT , YTILT , ZROT (4-6) 

* OUTPUTS : 

* CPH,XPH, YPH, ZPH : GLOBAL POSITIONS OF THE C,X,Y,Z HYDROPHONES FOR 

* CENTER AND SATELLITE SENSORS (FIRST ELEMENT 1-7) 

* PU,AU : CURRENT DATA FOR THE CENTER SENSOR PU-POSITION, AU- 

* ANGULAR ORIENTATION 



DIMENSION CPH (7, 3 ) , SHI FT ( 7 , 6 ) , X { 3 ) , A ( 3 ) , ERROR ( 7 , 6 ) , 
£ XPH (7,3), YPH (7,3), ZPH ( 7 , 3 ) , PU ( 3 ) , AU ( 3 ) , 

& CP ( 3 ) , XP ( 3 ) , YP ( 3 ) , ZP ( 3 ) , SENSR ( 7 ) 



DOUBLE PRECISION CPH , XPH , YPH, ZPH, X, A , AU , PU , SHIFT , 
£ XP, YP, ZP, CP, ERROR 

INTEGER SENSR, I, ERR, EXT, DVP 
CHARACTER* 15 NAMEl 



C UPDATE POSITIONS OF C PHONES FROM PREVIOUS SHIFTS 



5 



1 = 0 

IF ( SENSR (I+l) .NE.0)THEN 
1 = 1 + 1 

CALL ARRAY ( SENSR (I),X(1),X(2) 



X(l) 

X(2) 

X(3) 

A(l) 

A(2) 



X(l) 

X(2) 

X(3) 

A(l) 

A(2) 



ERROR (I, 1) 
ERROR (1,2) 
ERROR (1,3) 
ERROR(I,4) 
ERROR (1,5) 



+ 

+ 

+ 

+ 



X(3),A(1),A(2 
SHIFT (1,1) 
SHIFT (I, 2) 
SHIFT(I,3) 
SHIFT( I ,4) 
SHIFT(I,5) 



A(3) ,ERR) 
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A(3) = A(3) + ERROR (I, 6) + SHIFT (I, 6) 

IF(I.EQ,1) THEN 
DO 10 N =1,3 
PU(N) = X(N) 

AU(N) = A(N) 

10 CONTINUE 

ENDIF 

CALL GLOBE(X,A,XP,YP,ZP,CP) 

DO 7 LP=1,3 

CPH(I,LP) = CP(LP) 

XPH(I,LP) = XP(LP) 

YPH(I,LP) = YP(LP) 

ZPH(I,LP) = ZP(LP) 

7 CONTINUE 

IF(I.LE. 6)GOTO 5 
ENDIF 

IF(SHIFT(1,3) .GT.O .AND, EXT.NE.2) THEN 
EXT = 1 

CALL VELPRO(0,NAME1,DVP,EXT,PU(3) ) 

ENDIF 

RETURN 

END 
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•k'k'k'kic'kiti 



:iciticic^ic^fci(icit'k'ki 



r * ★ * ★ ★ ★ 



SUBROUTINE FIND ( AR, K, MI , MA) 

* FIND THE MINIMUM AND MAXIMUM OF THE ARRAY AR OF SIZE K 

* J.A. GEMBARSKI 

* NFS 01/01/92 



DIMENSION AR(K) 

DOUBLE PRECISION AR,MI,MA 
INTEGER K,I 



MI = AR(1) 

MA = AR(1) 

DO 10 1=2, K 

IF(AR( I ) .GT.MA) MA = AR(I) 

IF(AR(I) .LT.MI) MI = AR(I) 

10 CONTINUE 
RETURN 
END 

*********************************************************** 
SUBROUTINE PLANE ( X , Y , CO , A , B, C , E ) 

* THIS SUBROUTINE FINDS THE EQUATION OF A PLANE, 

* PASSING THROUGH THE THREE POINTS X,Y,C0 

* J.A. GEMBARSKI 

* NPS 01/01/92 



DIMENSION X(3) ,Y(3) ,C0(3) 

DOUBLE PRECISION X , Y , CO , A, B , C , E 



A = X(2) • (Y(3) - C0(3)) 

& - X(3) • (Y(2) - C0(2) ) 

& + (Y(2) • CO (3) - Y(3) * CO (2)) 

B = - X(l) * (Y(3) - C0(3)) 

& + X(3) * (Y(l) - C0(1) ) 

& - (Y(l) * CO (3) - Y(3) * C0(1)) 

C = X(l) * (Y(2) - C0(2)) 

& - X(2) * (Y(l) - C0(1)) 

& + (Y(l) » CO (2) - Y(2) * C0(1)) 

E = - X(l) * (Y(2) * C0(3) - Y(3) * C0(2)) 

& + X(2) • (Y(l) • C0(3) - Y(3) • C0(1)) 

& - X(3) • (Y(l) * C0(2) - Y(2) * C0(1)) 

RETURN 

END 
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*******★*★*★***★*★*★****★★★*★★*★★*★★★★★★★★★*★***★★★*★★★★*★*★★★★★★★★*★** 



c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 



SUBROUTINE RAYFITl ( A1 , A2 , PI , P2 , M , VEL , LM , DZ , VO , VI , TO , THO , 

+ TH1,IEST) 

09/12/89 

NEW SUBROUTINE TO REPLACE TGEN, RAYTRACING ALGORITHM, 



NO CHANGES HAVE BEEN MADE TO THIS SUBROUTINE. RECIEVED FROM 
LIB12.FOR OF REF 1 

J.A. GEMBARSKI 
NPS 01/01/92 

4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r4r'*’4r4r4r4r4r4r4r 



INPUTS: 
Al, A2 
P1,P2 
LM 
M 

VEL 

VO 

VI 

DZ 

lEST 

OUTPUTS: 

TO 

THO 

THl 



POSITION OF SENSOR (A2 > 0 DOWN) 

POSITION OF SOUND SOURCE ( P2 > 0 DOWN ) 
ARRAY CONTAINING LAYER MIDPOINTS 
NUMBER OF LAYER MIDPOINTS 
ARRAY CONTAINING SOUND VELOCITY AT THE 
LAYER MIDPOINTS. 

SPEED INTERCEPT VALUES 
SPEED SLOPE VALUES 
DEPTH INCREMENTS 

FLAG FOR INITIALIZING THE ANGLE 
TRANSIT TIME 

ELEVATION ANGLE AT THE SENSOR 
ELEVATION ANGLE AT THE SOUND SOURCE 



'kic'k'k’k-k'k-k'k'k'k-kic'k-k-k-k^-k-k-k^-kic'k-k-k'k-kit-kif-k-k'kif-k^-kit-k^-k-k'k-k-kif-k^-k-k-k-k^-k^-k-k-k'ic-k-k 



DOUBLE PRECISION VEL ( 300 ) , DZ ( 300 ) , LM ( 300 ) , VO ( 300 ) 

DOUBLE PRECISION VI ( 300 ) , ANG ( 300 ) 

DOUBLE PRECISION Al , A2 , PI , P2 , TO , THO , THl , EP, S , C 
DOUBLE PRECISION H, HO , DW , VA2 , VP2 , R, Z , RV , Q1 , Q2 
INTEGER M, IS, I, lEST, J,N 

EP = lD-6 

C DETERMINE LAYERS INVOLVED IN RAY FITTING 
N = M 
J = M 

DO 30 1=1, M - 1 

IF ( (LM(I) .LE.A2) .AND. (LM(I+1) .GT.A2) ) N=I 
IF ( (LM(I) .LE.P2) .AND. (LM(I+1) .GT.P2) ) J=I 
30 CONTINUE 

C MAKE END CORRECTIONS FOR THE LAYERS 
DZ(N) = A2 - LM(N) 

DZ(J) = LM(J+1) - P2 

C COMPUTE SPEED OF SOUND AT A2 AND P2 

VA2 = V0(N) + V1(N)*A2 
VP2 = V0(J) + V1(J)*P2 
IF(IEST.NE.O) GOTO 50 

C INITIALIZE THE ELEVATION ANGLE AT THE SENSOR, THO, BY 
C FITTING A STRAIGHT LINE SPEED PROFILE BETWEEN P2 AND A2 . 
IF(VEL(N) .EQ.VEL(J) ) THEN 

THO = DATAN( (A2-P2 ) / (Pl-Al) ) 

ELSE 

Q2 = (VEL(N) *LM( J) - VEL( J) *LM(N) ) / ( VEL ( N ) -VEL ( J ) ) 
Q1 = 0.5*(P1+A1)+(0.5*(P2-A2)*(P2+A2-2*Q2))/(P1-A1) 
THO = DATAN( (Ql-Al) /(Q2-A2) ) 
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o o 



END IF 



C OUTER LOOP: SET UP RAY FITTING FOR THO = ELEVATION ANGLE 
50 S = DSIN(THO) 

C = DSQRT(1.0 - S**2) 

I = N 

RV = C/VA2 
HO = A1 
Z = A2 

60 IF(V1(I) .EQ.0.0) THEN 
DW = DZ(I)/S 
H = HO + DW*C 
ELSE 

Q2 = -V0(I)/V1(I) 

IF (Q2) 61,62,63 

61 IS = -1 
GOTO 64 

62 IS = 0 
GOTO 64 

63 IS = 1 

64 CONTINUE 

Q1 = HO + (Q2-Z)*S/C 
R = DSQRT( (Q2-Z)**2 + (Ql-H0)**2) 

C = RV*VEL(I) 

S = DSQRT(1.0-C**2) 

H = Q1 - IS*R*S 
END IF 

IF (I.EQ.J) GOTO 80 
HO = H 
Z = LM(I) 

1 = 1-1 
GOTO 60 

80 THl = DACOS(RV*VP2) 

C FRACTIONAL LAYER CORRECTION 

IF(V1(J) .NE.0.0) H = Q1 - IS*R*DSIN(TH1) 

IF (ABS(H-Pl) .LT.EP) GOTO 90 

C RE-ESTIMATE THO 

THO = DATAN(DTAN(THO) *H/P1) 

GOTO 50 

C PREPARE FOR COMPUTATION OF TRANSIT TIME. 

C COLLECT EXIT AND ENTRANCE ANGLES. 

90 ANG(J) = THl 
ANG(N+1) = THO 
G(J) = 1/V1(J) 

G(N+1) = -1.0/V1(N) 

DO 95 I = J+1,N 

ANG(I) = DACOS(RV*VEL( I ) ) 

C G(I) = (1/V1(I)) - (1/Vld-l)) 

95 CONTINUE 

C COMPUTE TRANSIT TIME 
TO = O.ODO 
DO 100 I = J,N 

IF(V1 ( I ) .EQ. 0.0) THEN 

TO = TO + DZ(I)/(VO(I)*DSIN(ANG(I) ) ) 
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ELSE 

TO=TO + DLOG( (DC0S(ANG(I+1) )*(1.0+DSIN(ANG(I) ) ) )/ 
* ( (1.0+DSIN(ANG(I+1) ) )*DCOS(ANG(I) ) ) ) /VI { I ) 

ENDIF 
100 CONTINUE 

C REMOVE THE END CORRECTIONS. 

DZ(J) = LM(J+1) - LM(J) 

DZ(N) = LM(N+1) - LM(N) 
lEST = 1 

RETURN 

END 
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****************************************************************** 



SUBROUTINE I SOGAD 1 ( A1 , A2 , TO , THO , N , LM , VEL ,V0,V1,DZ,H,Z,TH1) 

C 

C NO CHANGES HAVE BEEN MADE TO THIS SUBROUTINE. RECIEVED FROM 
C LIB12.FOR OF REF 1 (ORIGINAL NAME: ISOGRADl) 

C J.A. GEMBARSKI 

C NFS 01/01/92 

C 

C 09/25/89 

C TO : TRANSIT TIME (SEC). 

C THO ; ELEVATION ANGLE AT SENSOR (RAD). 

C A1 : HORIZONTAL COORDINATE OF SENSOR. 

C A2 : VERTICAL COORDINATE OF SENSOR, POSITIVE DOWN. 

C V0,V1 : ARRAYS CONTAINING SOUND VELOCITY PARAMETERS. 

C LM ; ARRAY CONTAINING LAYER MIDPOINTS. 

C N ; INDEX OF DEEPEST LAYER USED. 

C 

Q**************************************************************** 



DIMENSION LM(300) ,V0(300) ,V1(300) ,DZ(300) ,VEL(300) 
DOUBLE PRECISION TO , H, HO , Z , A1 , A2 , THO , THl , VEL 
DOUBLE PRECISION LM, VO , VI , DZ , Q1 , Q2 
DOUBLE PRECISION VA2 , R, TH , RV, DW , DT , X , T 
INTEGER N,IS,I 

I = N 
T = O.ODO 
TH=TH0 
HO = A1 

VA2=V0(I)+V1(I)*A2 
RV=DCOS(TH)/VA2 
Z = A2 

DZ(N) = Z - LM(N) 

50 IF(V1(I) .EQ.0.0) THEN 

DW = DZ(I)/DSIN(TH) 

DT = DW/V0(I) 

H = HO + DW*DCOS(TH) 

THl = TH 
ELSE 

Q2=-V0(I)/V1(I) 

IF (Q2) 51,52,53 

51 IS = -1 

GOTO 54 

52 IS = 0 

GOTO 54 

53 IS = 1 

54 CONTINUE 

Q1=H0 + (Q2-Z ) *DTAN(TH) 

R=DSQRT( (Q2-Z) **2 + (Ql-H0)**2) 

TH1=DAC0S(RV*VEL(I) ) 

DT=DLOG( (DCOS(TH)/(1.0+DSIN(TH) ) )*( ( 1 . 0+DS IN ( THl ) )/ 
* DCOS(THl) ) )/Vl(I) 

H=Q1 - IS*R*DSIN(TH1) 

ENDIF 

T=T+DT 

IF (T.GE.TO) GOTO 60 
Z=LM(I) 

HO = H 
TH=TH1 
1 = 1-1 
GOTO 50 
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60 DT=T0+DT-T 

IF(V1(I) .EQ.0.0) THEN 
DW = V0(I)*DT 
DZ(I) = DW*DSIN(TH1) 

H = HO + DW»DCOS(THl) 

Z = Z - DZ(I) 

ELSE 

X=(EXP(DT*V1(I) ) )*(1+DSIN(TH) )/DCOS(TH) 
TH1=DAC0S( (2*X)/(1+X**2) ) 

H = Q1 - IS*R*DSIN(TH1) 

Z = Q2 - IS*R*DCOS(THl) 

ENDIF 

C RESTORE THE END LAYERS. 

DZ(I) = LM(I+1) - LM(I) 

DZ(N) = LM(N+1) - LM(N) 

RETURN 

END 
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SUBROUTINE ARRAY ( AR , Al , A2 , A3 , XTILT , YTILT , ZROT , ERR ) 

C THIS SUBROUTINE PROVIDES RANGE COORDINATES OF THE ACOUSTIC 
C CENTERS OF THE NANOOSE ARRAYS 

C J.A. GEMBARSKI 

C NPS 01/01/92 

C 



REALMS A1,A2, A3, XTILT, YTILT, ZROT 
INTEGER*4 AR,ERR 

C ARRAY 0 

IF(AR.EQ.O) THEN 
A1 = 12188. OIDO 
A2 = -131.52D0 
A3 = 1295. 33D0 
XTILT = 0.002909 

YTILT = 0.014835 

ZROT = -0.208183 

C ARRAY 1 

ELSEIF(AR.EQ. 1) THEN 
A1 = 19463. 16D0 
A2 = -174.99D0 
A3 = 1308. 76D0 
XTILT = 0.061523 

YTILT = -0.036070 
ZROT = 1.362579 

C ARRAY 2 

ELSEIF(AR.EQ.2) THEN 
A1 = 26991. 39D0 
A2 = -109.83D0 
A3 = 1323. 35D0 
XTILT = 0.000145 

YTILT = 0.005236 

ZROT = 2.670336 

C ARRAY 3 

ELSEIF(AR.EQ. 3) THEN 
A1 = 34505. lODO 
A2 = -80.76D0 
A3 = 1323. 32D0 
XTILT = 0.027925 

YTILT = -0.011345 
ZROT = 2.928139 

C ARRAY 4 

ELSEIF(AR.EQ. 4) THEN 
A1 = 42005. 19D0 
A2 = -55.17D0 
A3 = 1318. 28D0 
XTILT = 0.001164 

YTILT = -0.040288 
ZROT = -2.315877 
C ARRAY 5 

ELSEIF(AR.EQ. 5 ) THEN 
A1 = 49497. OODO 
A2 = -25.23D0 
A3 = 1315. 58D0 
XTILT = -0.000291 
YTILT = -0.004027 
ZROT = 1.668535 

C ARRAY 6 
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ELSEIF(AR.EQ. 6) THEN 
A1 = 56972. 28D0 
A2 = -21.21D0 
A3 = 1308. 50D0 
XTILT = 0.013817 

YTILT = 0.041161 

ZROT = -0.703420 
C ARRAY 7 

ELSEIF(AR.EQ.7) THEN 
A1 = 64680. 66D0 
A2 = 15.33D0 

A3 = 1353. 39D0 
XTILT = 0.034907 

YTILT = 0.022835 

ZROT = -0.574144 
C ARRAY 8 

ELSEIF(AR.EQ.S) THEN 
A1 = 71969. 73D0 
A2 = -29.28D0 
A3 = 1300. 89D0 
XTILT = -0.005963 
YTILT = -0.012217 
ZROT = -1.577341 
C ARRAY 9 

ELSEIF(AR.EQ.9) THEN 
A1 = 3.00D0 

A2 = 3.00D0 

A3 = l.OODO 

XTILT = 0.000000 

YTILT = 0.000000 

ZROT = 0.000000 

C ARRAY 10 

ELSEIF(AR.EQ. 10) THEN 
A1 = 47100. OODO 
A2 = -3600. OODO 
A3 = 1300. OODO 
XTILT = 0.000000 

YTILT = 0.000000 

ZROT = 0.000000 

C ARRAY 11 

ELSEIF(AR.EQ. 11) THEN 
A1 = 23173. 89D0 
A2 = -6488. 40D0 
A3 = 1312. 09D0 
XTILT = -0.004654 
YTILT = 0.000436 

ZROT = 2.784376 

C ARRAY 12 

ELSEIF(AR.EQ. 12 ) THEN 
A1 = 30731. 25D0 
A2 = -6553. 05D0 
A3 = 1312. 90D0 
XTILT = 0.002036 

YTILT = 0.001745 

ZROT = -3.042179 
C ARRAY 13 

ELSEIF(AR.EQ. 13) THEN 
A1 = 38213. 61D0 
A2 = -6640. 77D0 
A3 = 1323. 05D0 
XTILT = 0.000291 
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YTILT = 0.006254 

ZROT = 1.373522 

C ARRAY 14 

ELSEIF(AR.EQ. 14) THEN 
A1 = 45647. 07D0 
A2 = -6513. 18D0 
A3 = 1324. 78D0 
XTILT = 0.001309 

YTILT = 0.002327 

ZROT = -2.348044 
C ARRAY 15 

ELSEIF(AR.EQ. 15 ) THEN 
A1 = 53249. 43D0 
A2 = -6354. 60D0 
A3 = 1316. 66D0 
XTILT = 0.003345 

YTILT = 0.004509 

ZROT = 0.581544 

C ARRAY 16 

ELSEIF(AR.EQ. 16) THEN 
A1 = 60859. 74D0 
A2 = -6356. 07D0 
A3 = 1313. 42D0 
XTILT = 0.014835 

YTILT = 0.036943 

ZROT = 2.303276 

C ARRAY 17 

ELSEIF(AR.EQ. 17 ) THEN 
A1 = 68217. 93D0 
A2 = -6524. lODO 
A3 = 1313. 43D0 
XTILT = 0.008290 

YTILT = 0.034761 

ZROT = 2.158449 

C ARRAY 54 

ELSEIF(AR.EQ. 54) THEN 
A1 = 38029. 95D0 
A2 = 5401. 98D0 

A3 = 1212. 69D0 
XTILT = 0.007709 

YTILT = -0.003782 
ZROT = -1.056919 
C ARRAY 55 

ELSEIF(AR.EQ. 55) THEN 
A1 = 45645. 75D0 
A2 = 6369. 66D0 
A3 = 1188. 12D0 
XTILT = 0.027634 

YTILT = 0.039415 

ZROT = -0.728553 
C ARRAY 56 

ELSEIF(AR.EQ.56) THEN 
A1 = 53180. 13D0 
A2 = 6417. 96D0 

A3 = 1218. 84D0 

XTILT = 0.037525 

YTILT = 0.048142 

ZROT = -1.392651 
C ARRAY 57 

ELSEIF{AR.EQ. 57) THEN 
A1 = 60745. 71D0 



A2 = 6419. 40DO 

A3 = 1088. 24DO 
XTILT = 0.006981 

YTILT = 0.001891 

ZROT = -3.108606 
C ARRAY 23 

ELSEIF(AR.EQ.23) THEN 
A1 = 41605. 14D0 
A2 =-12150.1800 
A3 = 1268.2300 
XTILT = -0.002182 
YTILT = 0.003200 

ZROT = -1.845214 
C ARRAY 24 

ELSEIF(AR.EQ.24) THEN 
A1 = 49572.0000 
A2 =-12966.0000 
A3 = 1300.0000 
XTILT = -0.007272 
YTILT = 0.055269 

ZROT = -1.343904 
C ARRAY 25 

ELSEIF(AR.EQ.25) THEN 
A1 = 56993.7900 
A2 =-12999.3300 
A3 = 1205.4800 
XTILT = 0.000291 

YTILT = -0.002182 
ZROT = -0.593726 
C ARRAY 26 

ELSEIF(AR.EQ. 26) THEN 
A1 = 64442.9400 
A2 =-12971.0400 
A3 = 1255.3500 
XTILT = -0.014835 
YTILT = -0.012654 
ZROT = 3.134192 

C ARRAY 27 

ELSEIF(AR.EQ.27) THEN 
A1 = 22119.6000 
A2 =-15908.7000 
A3 = -83.0000 

XTILT = 0.000000 

YTILT = 0.000000 

ZROT = 0.000000 

C ARRAY 28 

ELSEIF(AR.EQ.28) THEN 
A1 = 45000.0000 
A2 = 1500.0000 

A3 = 1350.0000 
XTILT = 0.000000 

YTILT = 0.000000 

ZROT = 0.000000 

C ARRAY 29 

ELSEIF(AR.EQ.29) THEN 
A1 = 0.0000 

A2 = 0.0000 

A3 = 0.0000 

XTILT = 0.000000 

YTILT = 0.000000 

ZROT = 0.000000 
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ELSE 




A1 = 0. 


ODO 


A2 = 0. 


ODO 


A3 = 0. 


ODO 


XTILT = 


0.000000 


YTILT = 


0.000000 


ZROT = 


0.000000 


ERR = 1 




ENDIF 




RETURN 




END 
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A********************************************************************** 



SUBROUTINE FINDOVR( I , REGION, ERR) 



SUBROUTINE TO FIND ALL CROSSOVER REGIONS FOR THE GIVEN ARRAY 
ON THE NANOOSE RANGE. 

J.A. GEMBARSKI 
NFS 01/10/92 



DIMENSION REGION(6) 
INTEGER*4 I , REGION , ERR, K 

DO 10 K =1,6 
REGION(K) = 0 
10 CONTINUE 
ERR = 0 



ARRAY 1 

IF(I .EQ. 1 )THEN 
REGION(l) = 1 
ARRAY 2 

ELSEIF(I .EQ. 2 ) THEN 



)THEN 



REGION(l) 


= 


1 


REGION(2) 


= 


2 


REGION(3) 


= 


3 


ARRAY 3 


ELSEIF(I .EQ. 


3 


REGION(l) 


= 


3 


REGION (2) 


= 


4 


REGION (3) 


= 


5 


REGION(4) 


= 


6 


ARRAY 4 


ELSEIF(I .EQ. 


4 


REGION(l) 


= 


5 


region! 2 ) 


= 


6 


REGION(3) 


= 


7 


REGI0N(4) 


= 


8 


REGION(5) 


= 


9 


REGION (6) 


= 


10 


ARRAY 5 


ELSEIF(I .EQ. 


5 


REGION(l) 


= 


8 


REGION(2) 


= 


9 


REGION(3) 


= 


14 


REGION(4) 


= 


15 


REGION(5) 


= 


16 


REGION(6) 


= 


17 


ARRAY 6 


ELSEIF(I .EQ. 


6 


REGION(l) 


= 


15 


REGION(2 ) 


= 


16 


REGION(3) 


= 


18 


REGION(4) 


= 


19 


region! 5) 


= 


20 


REGION(6) 


= 


21 


ARRAY 7 


ELSEIF(I .EQ. 


7 


REGION(l) 


= 


19 


REGION(2) 


= 


20 


REGION(3) 


= 


26 


REGION(4) 


= 


27 



)THEN 



)THEN 



)THEN 



)THEN 



ARRAY 8 
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ELSEIF(I .EQ. 


8 ) 


THEN 




REGION(l) = 


27 




c 


ARRAY 11 








ELSEIF(I .EQ. 


11) 


THEN 




REGION(l) = 


1 






REGION(2) = 


2 




c 


ARRAY 12 








ELSEIF(I .EQ. 


12) 


THEN 




REGION(l) = 


2 






REGION (2) = 


3 






REGION(3) = 


4 




c 


ARRAY 13 








ELSEIF(I .EQ. 


13) 


THEN 




REGION(l) = 


4 






REGION(2) = 


5 






REGION(3) = 


10 






REGION(4) = 


11 




c 


ARRAY 14 








ELSEIF(I .EQ. 


14) 


THEN 




REGION(l) = 


9 






REGION(2) = 


10 






REGION(3) = 


11 






REGION (4) = 


12 






REGION(5) = 


13 






REGION(6) = 


14 




c 


ARRAY 15 








ELSEIF(I .EQ. 


15) 


THEN 




REGION (1) = 


13 






REGION(2) = 


14 






REGION(3) = 


15 






REGION(4) = 


21 






REGION(5) = 


22 






REGION(6) = 


23 




c 


ARRAY 1 6 








ELSEIF(I .EQ. 


16) 


THEN 




REGION(l) = 


20 






REGION(2) = 


21 






REGION(3) = 


22 






REGION(4) = 


24 






REGI0N(5) = 


25 






REGION(6) = 


26 




c 


ARRAY 17 








ELSEIF(I .EQ. 


17) 


THEN 




REGION(l) = 


25 






REGION(2) = 


26 






REGION(3) = 


27 




c 


ARRAY 23 








ELSEIF(I .EQ. 


23) 


THEN 




REGION(l) = 


11 






REGION (2) = 


12 




c 


ARRAY 24 








ELSEIF(I .EQ. 


24) 


THEN 




REGION(l) = 


12 






REGION (2) = 


13 






REGION(3) = 


23 




c 


ARRAY 25 








ELSEIF(I .EQ. 


25) 


THEN 




REGION(l) = 


22 






REGION(2) = 


23 






REGION(3) = 


24 




c 


ARRAY 26 
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ELSEIF(I .EQ. 


26) THEN 




REGION(l) = 


24 




REGION(2) = 


25 


c 


ARRAY 54 






ELSEIF(I .EQ. 


54) THEN 




REGION(l) = 


6 




REGION (2) = 


7 


c 


ARRAY 55 






ELSEIF(I .EQ. 


55) THEN 




REGION(l) = 


7 




REGION (2) = 


8 




REGION(3) = 


17 


c 


ARRAY 56 






ELSEIF(I .EQ. 


56) THEN 




REGION(l) = 


16 




REGION(2) = 


17 




REGION(3) = 


18 


c 


ARRAY 57 






ELSEIF(I .EQ. 


57) THEN 




REGION(l) = 


18 




REGION(2) = 


19 



ELSE 

ERR = 1 
ENDIF 
RETURN 
END 



113 






★ 



* 



SUBROUTINE OVERLAP ( J, AR, ERR) 

SUBROUTINE TO RETURN THE ARRAYS ASSOCIATED WITH THE INPUT 
CROSSOVER REGION J FOR THE NANOOSE RANGE. 

J.A. GEMBARSKI 
NPS 01/01/92 



DIMENSION AR(3) 
INTEGER*4 ERR,J,AR 



C 



C 



c 



c 



c 



c 



c 



c 



c 



c 



REGION 1 
IF(J .EQ. 
AR(1) = 
AR(2) = 
AR(3) = 
REGION 2 
ELSEIF(J 
AR(1) = 
AR(2) = 
AR(3) = 
REGION 3 
ELSEIF( J 
AR(1) = 
AR(2) = 
AR ( 3 ) = 
REGION 4 
ELSEIF( J 
AR(1) = 
AR(2) = 
AR(3) = 
REGION 5 
ELSEIF( J 
AR(1) = 
AR(2) = 
AR ( 3 ) = 
REGION 6 
ELSEIF( J 
AR(1) = 
AR(2) = 
AR(3) = 
REGION 7 
ELSEIF( J 
AR(1) = 
AR(2) = 
AR(3) = 
REGION 8 
ELSEIF( J 
AR(1) = 
AR(2) = 
AR(3) = 
REGION 9 
ELSEIF( J 
AR(1) = 
AR(2) = 
AR(3) = 
REGION 10 
ELSEIF( J 
AR(1) = 
AR(2) = 
AR(3) = 



1 )THEN 
1 

2 

11 

.EQ. 2 )THEN 

2 

11 

12 

.EQ. 3 )THEN 
2 
3 

12 

.EQ. 4 )THEN 
3 

12 

13 

.EQ. 5 )THEN 

3 

4 

13 

.EQ. 6 )THEN 

3 

4 

54 

.EQ. 7 )THEN 
4 

54 

55 

.EQ. 8 )THEN 

4 

5 

55 

.EQ. 9 )THEN 

4 

5 

14 

.EQ. 10)THEN 
4 

13 

14 
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C REGION 11 

ELSEIF(J .EQ. 
AR(1) = 13 
AR(2) = 14 
AR(3) = 23 
C REGION 12 

ELSEIF{J .EQ. 
AR{1) = 14 
AR{2) = 23 
AR{3) = 24 
C REGION 13 

ELSEIF(J .EQ. 
AR(1) = 14 
AR{2) = 15 
AR{3) = 24 
C REGION 14 

ELSEIF{J .EQ. 
AR(1) = 5 
AR(2) = 14 
AR(3) = 15 
C REGION 15 

ELSEIF(J .EQ. 
AR(1) = 5 
AR(2) = 6 
AR{3) = 15 
C REGION 16 

ELSEIF{J .EQ. 
AR{1) = 5 
AR{2) = 6 
AR(3) = 56 
C REGION 17 

ELSEIF{J .EQ. 
AR{1) = 5 
AR{2) = 55 
AR{3) = 56 
C REGION 18 

ELSEIF{J .EQ. 
AR{1) = 6 
AR{2) = 56 
AR{3) = 57 
C REGION 19 

ELSEIF(J .EQ. 
AR(1) = 6 
AR{2) = 7 
AR{3) = 57 
C REGION 20 

ELSEIF{J .EQ. 
AR(1) = 6 
AR(2) = 7 
AR(3) = 16 
C REGION 21 

ELSEIF(J .EQ. 
AR(1) = 6 
AR{2) = 15 
AR(3) = 16 
C REGION 22 

ELSEIF(J .EQ. 
AR{1) = 15 
AR{2) = 16 
AR{3) = 25 
C REGION 23 



11) THEN 



12) THEN 



13) THEN 



14) THEN 



15) THEN 



16) THEN 



17) THEN 



18) THEN 



19) THEN 



20) THEN 



21) THEN 



22) THEN 
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ELSEIF(J .EQ. 
AR(1) = 15 
AR(2) = 24 
AR(3) = 25 
C REGION 24 

ELSEIF(J .EQ. 
AR(1) = 16 
AR(2) = 25 
AR(3) = 26 
C REGION 25 

ELSEIF(J -EQ. 
AR(1) = 16 
AR(2) = 17 
AR(3) = 26 
C REGION 26 

ELSEIF(J .EQ. 
AR(1) = 7 
AR(2) = 16 
AR(3) = 17 
C REGION 27 

ELSEIF(J .EQ. 
AR(1) = 7 
AR ( 2 ) = 8 
AR(3) = 17 
ELSE 

AR ( 1 ) = 0 
AR(2) = 0 
AR ( 3 ) = 0 
ERR = 1 
END IF 
RETURN 
END 



23) THEN 



24) THEN 



25) THEN 



26) THEN 



27 ) THEN 
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SUBROUTINE POINTST ( J , XO , YO , ZO ) 

* 

* SUBROUTINE TO FIND THE INITIAL STARTING POINT (THE CENTER OF A 

* TRIPLE OVERLAP REGION) XO AND YO, FOR OVERLAP REGION J. 

* THE INITIAL STARTING POINT IS AT DEPTH XO (400 FT) ARBITRARILY 

* J.A. GEMBARSKI 

* NPS 01/01/92 



DIMENSION X(3) ,Y(3) ,Z(3) ,AR(3) 

REAL*8 X, Y, Z,X0,Y0, ZO , NUMl , NUM2 , DEN, A, B, C 

INTEGER*4 J,AR,ERR 

* 

CALL OVERLAP (J,AR, ERR) 

* 

DO 10 1=1,3 

CALL ARRAY(AR(I) ,X(I),Y(I),Z(I) ,A,B,C,ERR) 

10 CONTINUE 

* 

C SET THE DEPTH OF THE STARTING POINT 

* 

ZO = 400.0 

* 

NUMl = (X(2)**2-X(1)**2+Y(2)**2-Y(1)**2)/(X(2)-X(1) ) 

NUM2 = (X(3)**2-X(1)**2+Y(3)**2-Y(1)**2)/(X(3)-X(1) ) 

DEN = 2*( (V(l)-Y(3) )/(X(3)-X(l) )-(Y(l)-Y(2) )/(X(2)-X(l) ) ) 

★ 

YO = (NUMl - NUM2)/DEN 

XO = NUMl/2 + Y0*(Y(1)-Y(2) )/(X(2)-X(l) ) 

★ 

RETURN 

END 

SUBROUTINE GLOBE ( P , A , XP , YP , ZP, CP) 

★ 

* THIS SUBROUTINE DETERMINES THE GLOBAL POSITIONS OF EACH HYDROPHONE 

* OF THE IMPUTED ARRAY. INPUT POSITION IS THAT OF THE ACOUSTIC 

* CENTER. 

* 

* INPUTS 

* P: POSITION ARRAY P(l) P(2) P(3), X,Y,Z POSITIONS RESPECTIVELY 

* A: ORIENTATION ARRAY A(1),A(2),A(3) XTILT , YTILT , ZROT RESPECT. 

» 

* OUTPUTS 

* XP: POSITION OF THE X HYDROPHONE OF THE SENSOR X,Y,Z COORDINATES 

* RESPECTIVELY 

* YP,ZP,CP: THE Y, Z, AND C HYDROPHONE POSITIONS 

* J.A. GEMBARSKI 

* NPS 01/01/92 



DIMENSION B(5,3),XP(3),YP(3),ZP(3),CP(3),P(3),A(3) 
INTEGER I 

DOUBLE PRECISION P , A, B , Si , S2 , S3 , Cl , C2 , C3 , D , XP , YP , ZP , CP 
D=30.0D0 



* FORM THE SINES AND COSINES OF ALL EULER ANGLES : ROLL , PITCH AND YAW 

* 

S2=DSIN(A(1) ) 

C2=DSQRT( 1-S2**2 ) 

S1=DSIN(A(2) )/C2 
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C1=DSQRT( 1-S1**2 ) 

S3=-DSIN(A(3) ) 

C3=DCOS(A(3) ) 

FORM THE B TRANSITION MATRIX 

B(1,1)=C2*C3 

B(1,2)=C2*S3 

B(1,3)=S2 

B(2, 1)=-S1*S2*C3-C1*S3 
B(2,2)=-S1*S2*S3+C1*C3 
B(2,3)=S1*C2 
B(3, 1)=-C1*S2*C3+S1*S3 
B(3, 2 )=-Cl*S2*S3-Sl*C3 
B(3,3)=C1*C2 
DO 66 1=1,3 
B(4, I)=O.ODO 

B(5,I)= 0.5*(B(I,1) + B(I,2) + B(I,3)) 

66 CONTINUE 

PRINT*, ’B1',B(1,1),B(1,2),B(1,3) 

PRINT*, ’B2',B(2,1),B(2,2),B(2,3) 

PRINT*, ’B3',B(3,1),B(3,2),B(3,3) 

LOCATE THE X,Y,Z,C HYDROPHONE LOCATIONS 

XP(1)=P(1) + (D)*(B(1,1)-B(5,1) ) 

XP(2)=P(2) + (D)*(B(1,2)-B(5,2) ) 

XP(3)=P{3) + (D)*(B(5,3)-B(1,3) ) 

YP(1)=P(1) + (D)*(B(2,1)-B(5,1) ) 

YP(2)=P(2) + (D)*(B(2,2)-B(5,2) ) 

YP(3)=P(3) + (D)*(B(5,3)-B(2,3) ) 

ZP(1)=P{1) + (D)*(B(3,1)-B(5,1) ) 

ZP(2)=P(2) + (D)*(B(3,2)-B(5,2) ) 

ZP(3)=P(3) + (D)*(B(5,3)-B(3,3) ) 

CP(1)=P(1) + (D)*(B(4,1)-B(5,1) ) 

CP(2)=P(2) + (D)*(B(4,2)-B{5,2) ) 

CP(3)=P(3) + (D)*(B(5,3)-B{4,3) ) 

RETURN 

END 
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SUBROUTINE RERROR ( AR, ERRAR, ERR) 

THIS SUBROUTINE PROVIDES RANGE INDUCED ERRORS TO SENSORS 
(DELX,DELY,DELZ,DXTILT,DYTILT,D2ROT) FOR THE NANOOSE RANGE 
FOR INPUT INTO THE PROGRAM SIMSTRT 

J.A. GEMBARSKI 
NPS 01/01/92 



DIMENSION ERRAR(6) 

DOUBLE PRECISION ERRAR,VAL 
INTEGER AR,ERR,NO 
CHARACTER*! RES 
ARRAY 0 

IF(AR.EQ.O) THEN 





ERRAR ( 1 ) 


= O.ODO 




ERRAR ( 2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR( 5) 


= O.ODO 




ERRAR (6) 


= O.ODO 


c 


ARRAY 1 






ELSEIF(AR. 


EQ.l) THEN 




ERRAR(l) 


= O.ODO 




ERRAR ( 2 ) 


= O.ODO 




ERRAR(3 ) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 2 






ELSEIF(AR. 


EQ.2) THEN 




ERRAR ( 1 ) 


= O.ODO 




ERRAR(2) 


= O.ODO 




ERRAR ( 3 ) 


= O.ODO 




ERRAR ( 4 ) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR ( 6 ) 


= O.ODO 


c 


ARRAY 3 






ELSEIF(AR. 


EQ.3) THEN 




ERRAR(l) 


= O.ODO 




ERRAR(2) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR (6) 


= O.ODO 


c 


ARRAY 4 






ELSEIF(AR. 


EQ.4) THEN 




ERRAR(l) 


= O.ODO 




ERRAR(2 ) 


= O.ODO 




ERRAR(3 ) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR( 5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 5 






ELSEIF(AR. 


EQ.5) THEN 


c 


ERRAR(l) 


= 7.9D0 


c 


ERRAR(2) 


=-6.2D0 


c 


ERRAR(3) 


=-1.8D0 


c 


ERRAR(4) 


= 0.007D0 


c 


ERRAR(S) 


=-0.003D0 


c 


ERRAR(6) 


= O.OOIDO 
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ERRAR(l) 


= O.ODO 




ERRAR(2) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 6 






ELSEIF(AR.: 


EQ.6) THEN 


c 


ERRAR(l) 


=-5.0D0 


c 


ERRAR(2) 


= 7.0D0 


c 


ERRAR(3) 


= 4.0D0 


c 


ERRAR(4) 


= 0.005D0 


c 


ERRAR(5) 


= 0.002D0 


c 


ERRAR(6) 


=-0.003D0 




ERRAR(l) 


= O.ODO 




ERRAR(2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR ( 6 ) 


= O.ODO 


c 


ARRAY 7 






ELSEIF(AR. 


EQ.7) THEN 




ERRAR ( 1 ) 


= O.ODO 




ERRAR ( 2 ) 


= O.ODO 




ERRAR ( 3 ) 


= O.ODO 




ERRAR ( 4 ) 


= O.ODO 




ERRAR ( 5 ) 


= O.ODO 




ERRAR ( 6 ) 


= O.ODO 


c 


ARRAY 8 






ELSEIF(AR. 


EQ.8) THEN 




ERRAR ( 1 ) 


= O.ODO 




ERRAR ( 2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR ( 5 ) 


= O.ODO 




ERRAR ( 6 ) 


= O.ODO 


c 


ARRAY 9 






ELSEIF(AR. 


EQ.9) THEN 




ERRAR ( 1 ) 


= O.ODO 




ERRAR(2) 


= O.ODO 




ERRAR ( 3 ) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR ( 5 ) 


= O.ODO 




ERRAR ( 6 ) 


= O.ODO 


c 


ARRAY 10 






ELSEIF(AR. 


EQ.IO) THEN 




ERRAR ( 1 ) 


= O.ODO 




ERRAR ( 2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 11 






ELSEIF(AR. 


EQ.ll) THEN 




ERRAR ( 1 ) 


= O.ODO 




ERRAR(2) 


= O.ODO 




ERRAR ( 3 ) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 12 
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ELSEIF(AR.EQ. 12 ) THEN 





ERRAR(l) 


= O.ODO 




ERRAR(2) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR{6) 


= O.ODO 


c 


ARRAY 13 






ELSEIF(AR.: 


EQ.13) THEN 




ERRAR(l) 


= O.ODO 




ERRAR(2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 14 






ELSEIF(AR.: 


EQ.14) THEN 




ERRAR(l) 


= O.ODO 




ERRAR{2) 


= O.ODO 




ERRAR{3) 


= O.ODO 




ERRAR{4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ERRAR( 1) 


= 4.0D0 


c 


ERRAR ( 2 ) 


=-8.0D0 


c 


ERRAR ( 3 ) 


= 5.0D0 


c 


ERRAR ( 4 ) 


=-0.009D0 


c 


ERRAR ( 5 ) 


=-0.004D0 


c 


ERRAR ( 6 ) 


= 0.003D0 


c 


ARRAY 15 






ELSEIF(AR. 


EQ.15) THEN 




ERRAR { 1 ) 


= ll.ODO 




ERRAR(2) 


= 28.0D0 




ERRAR ( 3 ) 


= -2.0D0 




ERRAR ( 4 ) 


= 0.025D0 




ERRAR { 5 ) 


= O.OIODO 




ERRAR( 6) 


=-0.010D0 


c 


ERRAR { 1 ) 


= O.ODO 


c 


ERRAR ( 2 ) 


= O.ODO 


c 


ERRAR { 3 ) 


= O.ODO 


c 


ERRAR ( 4 ) 


= O.ODO 


c 


ERRAR(5) 


= O.ODO 


c 


ERRAR { 6 ) 


= O.ODO 


c 


ARRAY 16 






ELSEIF(AR. 


EQ.16) THEN 




ERRAR(l) 


= O.ODO 




ERRAR{2) 


= O.ODO 




ERRAR ( 3 ) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR{5) 


= O.ODO 




ERRAR ( 6 ) 


= O.ODO 


c 


ARRAY 17 






ELSEIF(AR. 


EQ.17) THEN 




ERRAR { 1 ) 


= O.ODO 




ERRAR(2) 


= O.ODO 




ERRAR ( 3 ) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR{5) 


= O.ODO 




ERRAR{6) 


= O.ODO 


c 


ARRAY 54 






ELSEIF(AR. 


EQ.54) THEN 





ERRAR(l) 


= O.ODO 




ERRAR(2 ) 


= O.ODO 




ERRAR{3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 55 






ELSEIF(AR. 


EQ.55) THEN 




ERRAR(l) 


= O.ODO 




ERRAR(2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 56 






ELSEIF(AR. 


EQ.56) THEN 




ERRAR(l) 


= O.ODO 




ERRAR(2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 57 






ELSEIF(AR. 


EQ.57) THEN 




ERRAR(l) 


= O.ODO 




ERRAR(2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4 ) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 23 






ELSEIF(AR. 


EQ.23) THEN 




ERRAR(l) 


= O.ODO 




ERRAR(2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4 ) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 24 






ELSEIF(AR. 


EQ.24) THEN 


c 


ERRAR ( 1 ) 


=-0. 5D0 


c 


ERRAR ( 2 ) 


=-1.0D0 


c 


ERRAR(3) 


= 0.7D0 


c 


ERRAR(4) 


=-0.010D0 


c 


ERRAR ( 5 ) 


= 0.005D0 


c 


ERRAR(6) 


=-0.020D0 




ERRAR(l) 


= O.ODO 




ERRAR(2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR(4 ) 


= O.ODO 




ERRAR( 5) 


= O.ODO 




ERRAR(6) 


= O.ODO 


c 


ARRAY 25 






ELSEIF(AR. 


EQ.25) THEN 




ERRAR ( 1 ) 


= O.ODO 




ERRAR ( 2 ) 


= O.ODO 




ERRAR(3) 


= O.ODO 




ERRAR ( 4 ) 


= O.ODO 




ERRAR(5) 


= O.ODO 




ERRAR ( 6 ) 


= O.ODO 


c 


ARRAY 26 





ELSEIF(AR.EQ. 
ERRAR(l) = 
ERRAR(2) = 
ERRAR(3) = 
ERRAR(4) = 
ERRAR(5) = 
ERRAR(6) = 
C ARRAY 27 

ELSEIF(AR.EQ. 
ERRAR(l) = 
ERRAR(2) = 
ERRAR(3) = 
ERRAR(4) = 
ERRAR(5) = 
ERRAR(6) = 
C ARRAY 28 

ELSEIF(AR.EQ. 
ERRAR(l) = 
ERRAR(2) = 
ERRAR ( 3 ) = 
ERRAR(4) = 
ERRAR(5) = 
ERRAR ( 6 ) = 
C ARRAY 29 

ELSEIF(AR.EQ. 
ERRAR(l) = 
ERRAR ( 2 ) = 
ERRAR ( 3 ) = 
ERRAR ( 4 ) = 
ERRAR(5) = 
ERRAR(6) = 
ELSE 

ERRAR ( 1 ) = 
ERRAR ( 2 ) = 
ERRAR(3) = 
ERRAR(4) = 
ERRAR(5) = 
ERRAR(6) = 
ERR = 1 
ENDIF 
RETURN 

100 FORMAT (Al) 

END 



26) THEN 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 

27) THEN 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 

28) THEN 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 

29) THEN 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 

O.ODO 

O.ODO 

O.ODO 

O.ODO 

O.ODO 

O.ODO 
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APPENDIX F: COMPUTER PROGRAMS SHIFTER AND LONG (BASE) 



These FORTRAN programs are used to determin the SBL and LBL poslocs 
for the error correction methodology. 



C 

C 

C 

C 

C 

C 

C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 



SUBROUTINE SHIFTER (A2 , XTILT , YTILT , ZROT , T , K, NEW, H2 , THONE ) 



THIS PROGRAM IS A MODIFICATION OF ERRPROP (08/22/90) TO 
SHIFT THE POSLOC WHEN THE ARRAY IS MOVED. THE ORIGIN IS OVER THE C- 
HYDROPHONE AND THE PROPOSED SYSTEM IS APPLIED. A2 IS THE DEPTH OF 
THE GEOMETRIC CENTER OF THE ARRAY CUBE. THE ACOUSTIC CENTER IS 
THE C-HYDROPHONE. 

TRANSIT TIME ERROR. 

THIS IS FOR THE KTH POSLOC AS DEFINED FROM THE SOURCE PROGRAM 
(NEWERR OR SETUP) 



J.A. GEMBARSKI 
NPS 01/01/92 






INPUTS: 

A2: DEPTH OF THE CENTER OF THE ARRAY 

XTILT, YTILT, ZROT: ORIENTATION INFORMATION ABOUT THE 

SENSING ARRAY (RADIANS) 

D: LENGTH OF ARRAY EDGES. 

L: DEPTH OF LAYER BOUNDARIES. 

M: NUMBER OF RECORDS IN THE VELOCITY DEPTH PROFILE. 

VEL: AVERAGE SPEED OF SOUND IN THE LAYERS. 

K: POSLOC TO BE SHIFTED 

T: RAY TRANSIT TIMES FROM EACH HYDROPHONE X,Y,Z,C 

OUTPUTS: 

NEW: LOCAL COORDINATES OF THE SHIFTED POSLOC 

H2: THE HORIZONTAL RANGE TO THE SHIFTED POSLOC 

THONE: THE 'TRUE' ELEVATION ANGLE TO THE SHIFTED POSLOC 






DIMENSION B(5,3) ,DZ(300) , HD ( 5 ) ,L(300) 
DIMENSION LM(300) ,NEW(3) 

DIMENSION T(18,4) 

DIMENSION V0(300) ,V1(300) , VEL (300) ,X0(3) 
COMMON /SETl/ L, VEL, VO , VI , DZ , LM, M 



DOUBLE 

DOUBLE 

DOUBLE 



PRECISION B,DZ,HD,L,LM,PH1 
PRECISION T, THONE, VO, VI 
PRECISION VEL, XO, NEW 



DOUBLE 

DOUBLE 

DOUBLE 

DOUBLE 



PRECISION 

PRECISION 

PRECISION 

PRECISION 



A1 , A2 , A2M , Cl , C2 , C3 , CAZ , CX , CXO , CY 

CY0,CZ,CZ0,D 

PIE,S1,S2,S3,SAZ 

V,XTILT, YTILT, ZROT 



DOUBLE PRECISION H2,Z2,THE 



124 



INTEGER K,J,M,N 

PIE = DACOS(-l.ODO) 

D = 30.0D0 

C FORM SINES AND COSINES OF ALL THE EULER ANGLES : ROLL, PITCH, YAW 

52 = DSIN(XTILT) 

C2 = DSQRT(1.0 - S2**2) 

SI = DSIN(YTILT) /C2 
Cl = DSQRT(1.0 - Sl*»2) 

53 = -DSIN(ZROT) 

C3 = DCOS(ZROT) 

C IN THE COORDINATE SYSTEM HAVING CENTER AT THE C-HYDROPHONE 

C AND POSITIVE-UPWARD, THE LOCATIONS OF THE FOUR HYDROPHONES 

C (RELATIVE TO THE ARM LENGTH D) ARE DEVELOPED NEXT. 



B(l,l) 


= 


C2*C3 




B(l,2) 


= 


C2*S3 




B(l,3) 


= 


S2 




B(2,l) 


= 


-S1*S2*C3 


- C1*S3 


B(2,2) 


= 


-S1*S2*S3 


+ C1*C3 


B(2,3) 


= 


S1*C2 




B(3,l) 


= 


-C1*S2*C3 


+ S1*S3 


B(3,2) 


= 


-C1*S2*S3 


- S1*C3 


B(3,3) 


= 


C1*C2 





C LIKE NOTATION WILL BE USED TO LOCATE THE C-HYDROPHONE AND THE 
C ARRAY CENTER. 

DO 12 J = 1,3 

B(4,J) = O.ODO 

B(5,J) = 0.5*(B(J,1) + B(J,2) + B(J,3)) 

12 CONTINUE 

A1 = O.ODO 



C DETERMINE THE DEPTHS OF THE FOUR HYDROPHONES AND THE ARRAY CENTER. 
HD(1) = A2 + D*(B(5,3) - B(l,3)) 

HD(2) = A2 + D*(B(5,3) - B(2,3)) 

HD(3) = A2 + D*(B(5,3) - B(3,3)) 

HD(4) = A2 + D*(B(5,3) - B(4,3)) 

HD ( 5 ) = A2 

C FIND THE DEEPEST HYDROPHONE 
A2M = O.DO 
DO 51 J=l,4 

IF(HD(J) .GT.A2M) A2M = HD(J) 

51 CONTINUE 

C LOCATE THE WATER LAYER, N, CONTAINING THE ARRAY. 

N = M 

DO 37 J = 2,M 

IF( (LM( J-1) .LE.HD(4) ) .AND. (LM( J) .GT.HD(4) ) ) N = J-1 
37 CONTINUE 

IF(N.GE.M)THEN 

PRINT*, 'C HYDROPHONE IS DEEPER THAN CURRENT DEPTH-VELOCITY' 
PRINT*, 'PROFILE. PROGRAM TERMINATED IN SHIFT SUBROUTINE' 
PRINT*, 'POSLOC NUMBER' ,K 
STOP 
ENDIF 
C 
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n o 



V = VO(N) + V1(N)*HD(4) 

CALCULATE THE PRE-TILT CORRECTED APPARENT POSITION 
VfRITE(44,221)K 
DO 40 J = 1,3 

X0(J)=(D**2 + (V*T(K,4)-V*T(K, J) )* (V*T(K,4)+V*T(K, J) ) )/(2*D) 
C WRITE(44,222) J,X0(J) 

40 CONTINUE 



C COMPUTE DIRECTION COSINES . 

CXO = X0(1)/(V*T(K,4) ) 

CYO = X0(2)/(V*T(K,4) ) 

CZO = DSQRT(1.0 - CX0**2 - CY0**2) 
C WRITE(44,223)CXO,CYO,CZO 
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PERFORM 

CX 
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*czu 



B(3,l) 
B(3,2)*CZO 
B(3,3)*CZ0 



= B(1,1)*CX0 + B(2,1)*CY0 
CY = B(1,2)*CX0 + B(2,2)*CY0 
CZ = B(1,3)*CX0 + B(2,3)*CY0 
WRITE (44, 224 )CX,CY,CZ 
SAZ = CY/DSQRT(CX**2 + CY**2) 

CAZ = CX/DSQRT(CX**2 + CY**2) 

WRITE (44,225) SAZ , CAZ 
PHI = DATAN2 (SAZ,CAZ) 

THONE = 0.5*PIE - DACOS(CZ) 

WRITE (44, 226)PHl,THONE 

CALL ISOGADl(Al,HD(4) , T ( K, 4 ) , THONE , N , LM , VEL , VO , VI , DZ , H2 , 
Z2,THE) 



NEW(l) = H2*CAZ 
NEW(2) = H2*SAZ 
NEW(3) = Z2 



RETURN 

221 FORMAT(5X .’POSLOC NUMBER 



222 FORMAT(10X, 

223 FORMAT(/10X 

224 FORMAT(10X, 

225 FORMAT (/lOX 

226 FORMAT(/10X 
END 



XO’ , I1,F11.4) 
•CXO ’,F11.4, 
CX ■ ,F11.4, ’ 
•SAZ ',F11.4, 
•FM SHIFT PH 



, 12 /) 

CYO ’,F11.4,' CZO •,F11.4) 
CY • ,F11.4, • CZ • ,F11.4) 
CAZ ',F11.4) 

F11.4, • TH ' ,F11.4) 
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SUBROUTINE LONG ( TIME , LINKS , SENSR , CPH , K , XS , HD , THONE , TH , PHS , PHL , HO, 

& XL) 

C 

C 12/19/90 

C LONGBASE.FOR IS A LONG BASE LINE METHOD FOR TRIPLE CROSSOVER REGIONS 
C THIS IS A MODIFIED VERSION OF LONGBASE FROM REF 3. WHEN DETERMINING 

C THE ARRAY TO UPDATE (DH) A TOLERANCE LIMIT WAS PLACED ON THE CLOSEST 

C POSLOC DISTANCE SUCH THAT IF WITHIN EPS CHOOSE ARRAY 1 (INTERIOR) TO 
C UPDATE. 

C J.A. GEMBARSKI 

C NPS 01/01/92 



A1,A2,A3 are the location of the C-Hydrophones . 

A1(I) is the downrange location of the 3 arrays. 

A2 { I ) is the crossrange location of the 3 arrays. 

A3 (I) is the depth location of the 3 arrays. 

( Depth is positive down orientation ) . 

K IS THE OVERLAP REGION OF INTEREST 
THONE IS THE INITIAL ELEVATION ANGLES TO THE SBL POSLOCS 
HD IS THE HORIZONTAL DISTANCE TO THE SBL POSLOCS 
OUTPUTS 

TH ELEVATION ANGLES TO THE LONGBASE POSLOCS 
PHS/PHL AZIMUTHS TO THE SBL/LBL POSLOCS 
HO HORIZONTAL RANGE TO THE LBL POSLOCS 

XL LBL POSLOC COORDINATES 



DIMENSION A1 (3 ) , A2 (3 ) , A3 (3 ) ,X(3 ) , Y{3 ) , Z { 3 ) , THO { 3 ) , T(3 ) 

DIMENSION H{3) ,AR1{2) ,AR2{2) ,HD(18) ,PH0{3) ,PH1(3) 

DIMENSION XX(3) ,YY{3) ,AR(4) ,LM(300) ,DZ(300) ,V1(300) 

DIMENSION L(300) , VEL ( 300 ) , VO ( 300 ) , XL(6, 3 ) , THONE ( 18) ,HO( 18) 
DIMENSION PHS( 18) , PHL { 18 ) , TH ( 18 ) , CPH (7, 3 ) ,XS( 18, 3) 

DIMENSION LINKS(18) ,SENSR{7) ,TIME(18,4) 

COMMON /SETl/ L , VEL , VO , VI , DZ , LM, M 

DOUBLE PRECISION L , VEL , VO , VI , DZ , LM, HO, PHS, PHL, TH 
DOUBLE PRECISION A1 , A2 , A3 , X , Y, Z , DZO , THO , T, ZO , ZOO , H 
DOUBLE PRECISION D12 , D1 3 , D2 3 , ARl , AR2 , D1 , D2 , D3 , HD, PHO , PHI , XL 
DOUBLE PRECISION VA , VB , UA , UB , EPS , XX , YY , DS , DM, GAM , THONE , TIME , CPH , XS 

INTEGER DLl ,DL2 , DH, MARR, AR, ERR, K, LINKS , SENSR , I ,M, N 

EPS = lD-3 
ERR = 0 

C GAM is a convergence tuning constant. 

GAM = 5.0D0 

N = (3*K)-3 
DO 10 I =1,3 

A1(I) = CPH(LINKS(I+N),1) 

A2(I) = CPH(LINKS( I+N) , 2 ) 

A3(I) = CPH(LINKS(I+N) ,3) 

X(I) = XS(I+N,1) 

Y(I) = XS(I+N,2) 

Z(I) = XS(I+N,3) 

H(I) = HD(I+N) 

THO(I) = THONE (I+N) 

T(I) = TIME(I+N,4) 
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AR(I) = SENSR(LINKS(I+N) ) 
10 CONTINUE 



C Compute the max dz. 

DZO = MAX(DABS(Z(1)-Z(2) ),DABS(Z(1)-Z(3) ) ,DABS(Z(2)-Z(3) ) ) 
DO 70 I = 1,3 

PHO(I) = DATAN2(Y(I)-A2(I) ,X(I)-A1(I) ) 

70 CONTINUE 

C WRITE(3,280)AR(1) ,AR(2) ,AR(3) ,AR(4) 

C WRITE(3,250)A1(1) ,A2(1) ,A3(1) 

C WRITE(3,251)A1(2) ,A2(2) ,A3(2) 

C WRITE(3,252)A1(3) ,A2(3) ,A3(3) 

C WRITE(3,270)X(1) ,Y(1) ,Z(1) 

C WRITE(3,271)X(2) ,Y(2) ,Z(2) 

C WRITE(3,272)X(3) ,Y(3) ,Z(3) 

C WRITE(3, *) ' 

C WRITE(3,253)H(1) ,H(2),H(3) 

D12 = DSQRT( (X(2)-Al(l) )**2 + ( Y ( 2 ) -A2 ( 1 ) ) * *2 ) 

D13 = DSQRT( (X(3)-A1(1) )**2 + ( Y ( 3 ) -A2 ( 1 ) ) * *2 ) 

IF ( (D12.GE.H(1) ) .OR. (D13.GE.H(1) ) ) THEN 
ZO = MAX(Z(1) ,Z(2) ,Z(3) ) 

ELSE 

ZO = MIN(Z(1) ,Z(2) ,Z(3) ) 

ENDIF 

DO 75 I = 1,3 

75 IF(Z(I) .EQ.ZO) MARR = I 
C WRITE(3,254)DS,Z0 

GOTO 720 

80 D1 = DSQRT( (UA-Al(DH) ) **2 + (VA-A2 (DH ) ) **2 ) 

D2 = DSQRT( (UB-Al(DH) )**2 + (VB-A2 (DH) ) **2 ) 

D3 = MIN(D1,D2) 

C WRITE(3,287) D1,D2 

IF(DABS(H(DH) - D3).LT.EPS) GOTO 100 

ZOO = ZO 

C RDH = DSQRT(H(DH) **2 + ( A3 ( DH ) -ZO ) **2 ) 

ZO = ZOO + (A3(DH) - Z00)*(1 - H ( DH ) /D3 ) *GAM 
DS = D3 - H(DH) 

WRITE(3,254)DS, ZO 
WRITE(3,253)H(1) ,H(2) ,H(3) 

720 CONTINUE 

DO 90 I = 1,3 

IF (I.EQ.MARR) GOTO 90 

CALL NEWLOC(O.ODO,A3 (I) ,TH0(I) ,T(I),H(I),Z(I),Z0) 

90 CONTINUE 

IF(MARR.EQ.4) GOTO 98 



C Adjust POSLOCs for new horizontal ranges. 
DO 95 I = 1,3 

IF(I .EQ.MARR) THEN 
XX(I) = X(I) 

YY(I) = Y(I) 
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ELSE 

XX(I) = A1(I) + H(I)*DCOS(PHO(I) ) 
yy(I) = A2(I) + H(I)*DSIN(PHO(I) ) 
ENDIF 
95 CONTINUE 



C 



C 



C 



Find the two closest POSLOCs. 

D12 = DSQRT((XX(1) - XX ( 2 ) 

D13 = DSQRT((XX(1) - XX(3) 

D23 = DSQRT((XX(2) - XX(3) 

DM = MIN(D12,D13,D23) 
WRITE(3,288)D12,D13,D23 
IF(DM.LT.EPS) DM = D23 
IF(DM.EQ.D23) THEN 
DLl = 2 
DL2 = 3 
DH = 1 

ELSEIF(DM.EQ.D13) THEN 
DLl = 1 
DL2 = 3 
DH = 2 
ELSE 

DLl = 1 
DL2 = 2 
DH = 3 
ENDIF 

WRITE (3, 255 )DH, GAM 

MARR = 4 
ARl(l) = Al(DLl) 

AR2(1) = A2(DL1) 

AR1(2) = A1(DL2) 

AR2(2) = A2(DL2) 



)**2 + 


(yy(i) 


- YV(2): 


1**2) 


)**2 + 


(yy(i) 


- vv(3): 


1**2) 


)**2 + 


(yy(2) 


- vv(3): 


>**2) 



98 CALL CIRCS0LV(AR1,AR2,H(DL1) ,H(DL2) ,UA,VA,UB,VB) 
C WRITE(3,285)UA,VA 

C WRITE(3,286)UB,VB 

GOTO 80 



100 CONTINUE 



IF(D3.EQ.D2) THEN 
VA = VB 
UA = UB 
ENDIF 

C WRITE(3,260)UA,VA, ZO 



XL(K, 1) 


= UA 


XL(K,2) 


= VA 


XL(K,3) 


= 20 


110 I = 


1,3 


HO(I+N) 


= H(I) 



PHO(I) = DATAN2 (y (I )-A2 (I) ,X( I )-Al 
PHI (I) = DATAN2(VA-A2(I),UA-A1(I) ) 
TH(I+N) = THO(I) 

PHS(I+N) = PHO(I) 

PHL(I+N) = PHI (I) 

C WRITE(3,261)AR(I) ,PH0(I) ,PH1(I) 

C WRITE(3,262)THONE(I+N) ,TH0(I) 

110 CONTINUE 



I) ) 
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RETURN 



250 

251 

252 

253 

254 

255 
260 

261 

262 

270 

271 

272 
280 

285 

286 

287 

288 



FORMAT (/lOX, ’Al(l)=’ ,F10.2, 
FORMAT (lOX, ’Al(2)=’ ,F10.2, ’ 
FORMAT (lOX, ’Al(3)=’ ,F10.2, ’ 
FORMAT (lOX, ’H(1)=’,F11.4,’ 
FORMAT ( /lOX, 'DS =’,F11.4,’ 
FORMAT ( /lOX, 'DH = ’,12, ‘ 
FORMAT ( //lOX, 'U =’,F10.2, 
F10.2) 

FORMAT ( /lOX, 'ARR #’,I2,’ 
FORMAT(21X, ’THOO = *,F10.6, 
FORMAT(/10X, 'X(l) =’,F10.2, 
FORMAT(10X, ’X(2) =’,F10.2,’ 
FORMAT(10X, ’X(3) =*,F10.2,’ 
FORMAT (1 OX, 'ARRAYS ',12,’, 
FORMAT (/ lOX, 'UA = ’,F10.2,' 
FORMAT (1 OX, 'UB = •,F10.2,’ 
FORMAT(/10X, 'D1 = •,F11.4,' 
FORMAT (/ lOX, *D 12 = ',F11.6, 
END 



• A2(l)=’ ,F10.2, 
A2(2)=' ,F10.2, • 
A2 (3) = ’ ,F10.2, ’ 

H(2)=’ ,F11.4, ■ 

ZO =',F11.4) 
GAM = • , F4 . 1 ) 

• V =• ,F10.2, ’ 

PHO = • ,F10.6, ■ 

' THO = • ,F10. 

• Y(l) =’,F10.2, 
Y(2) =’ ,F10.2, ’ 
Y(3) =’ ,F10.2, ' 

' , 12, ■ , and ' , 12,7 
VA =• ,F10.2) 

VB =• ,F10.2) 

D2 = ',F11.4) 

• D13 = • ,F11.6, 



A3 (1)= • ,F10. 2) 
A3(2)=’ ,F10.2) 
A3 (3)=’ ,F10.2) 
H(3)=' ,F11.4) 



ZO =' , 

PHI = • ,F10. 6) 

) 

Z(l) =’,F10.2) 
Z(2) =’,F10.2) 
Z(3) =',F10.2) 

, 'CASE ’,12) 



D23 = ’ ,F11. 6) 






SUBROUTINE NEWLOC ( A1 , A2 , THO , T , HO , Z , ZO) 



C 

C 

C INPUTS: 
C Al: 

C A2: 

C M: 

C THO: 

C T: 

C HO: 

C Z: 

C ZO: 

C 

C OUTPUTS: 
C THP: 

C 

C 



HORIZONTAL COORDINATE OF SENSOR 

VERTICAL COORDINATE OF SENSOR, POSITIVE DOWN 

INDEX OF DEEPEST LAYER USED 

ELEVATION ANGLE 

TRANSIT TIME 

HORIZONTAL RANGE 

DEPTH OF POSLOC 

DEPTH GOAL 



ADJUSTED ELEVATION ANGLE 



DIMENSION L(300) ,VEL(300) , VO (300) , VI (300) ,DZ(300) ,LM(300) 

COMMON /SETl/ L , VEL , VO , VI , DZ , LM, M 

DOUBLE PRECISION L , VEL , VO , VI , D Z , LM 

DOUBLE PRECISION THO , T , HO , Z , ZO , THP , EPS , Al , A2 , THl 

INTEGER J,M,N 



C compute the slant range 
EPS = .OOlODO 
DO 5 J = 2,M 

IF( (LM( J-1) .LE.A2) . AND. (LM(J) •GT.A2) ) N = J-1 

* PRINT*, ’N’ ,N, ’A2’ ,A2, ‘LMJ-1’ ,LM(J-1) , ' LM J ’ ,LM(J) 

5 CONTINUE 

THP = THO 
10 CONTINUE 

THP = THP - (Z0-Z)/H0 

* PRINT*, ’N’ ,N 

CALL I SOGAD 1 ( Al , A2 , T , THP , N , LM , VEL , VO , VI , D Z , HO , Z , TH 1 ) 
IF (DABS(Z-ZO) .GE.EPS) GOTO 10 

THO = THP 
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RETURN 

END 

SUBROUTINE CIRCSOLV ( A1 , A2 , HI , H2 , U1 , VI , U2 , V2 ) 

C 

C INPUTS: 

C Al: CENTER OF THE 1ST CIRCLE 

C A2: CENTER OF THE 2ND CIRCLE 

C H1,H2: RADIUS 

C OUTPUTS: 

C U1,V1: 1ST INTERSECTION POINT 

C U2,V2: 2ND INTERSECTION POINT 

C 

DIMENSION A1(2),A2(2) 

DOUBLE PRECISION Al , A2 , BO , B1 , HI , H2 , U1 , U2 , VI , V2 , PI , P2 , P3 , B2 
INTEGER ERR 

ERR = 0 

BO = Hl**2 - H2**2 + Al(2)**2 - Al(l)**2 + A2(2)**2 - A2(l)**2 
B1 = 2* (Al(2) - Al(l) ) 

B2 = 2*(A2(2) - A2(l) ) 

Bl = -B1/B2 
BO = B0/B2 
PI = 1+B1**2 

P2 = 2*B1*(B0-A2(1) )-2*Al(l) 

P3 = Al(l)**2 + (B0-A2(l) )**2 - Hl**2 
CALL QUAD(P1,P2,P3,U1,U2,ERR) 

IF (ERR.EQ.l) THEN 

WRITE(*,»)’ THERE WAS AN ERROR IN QUAD SOLUTION' 

STOP 

ENDIF 

VI = BO + B1*U1 
V2 = BO + B1*U2 
RETURN 
END 

Q* * -k * * * it ******************************************* -k ***************** * 

SUBROUTINE QUAD ( A , B , C, XI , X2 , ERR ) 

C 

DOUBLE PRECISION A, B , C, D , XI , X2 
INTEGER ERR 

D = b **2 - 4.0*A»C 
IF (D.LT.O.ODO) THEN 
ERR = 1 
GOTO 10 
ENDIF 

XI = (-B + DSQRT(D) )/(2.0*A) 

X2 = (-B - DSQRT(D) )/(2.0*A) 

10 RETURN 
END 
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APPENDIX G: COMPUTER PROGRAM VELPRO 



The VELPRO program sets up the water column for use in RAYFIT and 
ISOGAD subroutines • It also performs any DVP extrapolation required if an 
array hydrophone should exceed the deepest depth of the current profile. 
The extrapolation control can be overridden from the calling program. 



SUBROUTINE VELPRO ( OP , NAME 1 , N , EXT , A2 ) 

* 

* THIS A COMBINATION OF FORTRAN PROGRAMS VELMOD (2/22/90) AND 

* ERRPROP (8/22/90) IN LIB12.FOR OF REF 1. 

* - A CORRECTION WAS MADE TO THE EXTRAPOLATION PROCEDURE FROM ERRPROP 

* IN THE TERM GG. THE FACTOR OF 2 1 WAS INADVERTENTLY LEFT OUT OF 
« THE DENOMINATOR IN THE ORIGINAL PROGRAM. 

* THIS SUBROUTINE READS IN THE DEPTH VELOCITY PROFILE AND THEN 

* PERFORMS A DEPTH EXTENSION IF A2 IS DEEPER THAN THE LAST LAYER 

* J.A. GEMBARSKI 

» NPS 01/01/92 



DIMENSION L(300) ,VEL(300) , VO (300) ,Vl(300) ,DZ(300) ,LM(300) 

COMMON /SETl/ L , VEL, VO , VI , DZ , LM, M 

DOUBLE PRECISION L , VEL , LM , DZ , VO , VI , KO , G, GG , SV, SVU2 , SVU , SU2 , SU4 

DOUBLE PRECISION U,LB,A2 
INTEGER EXT,M,OP,N 
CHARACTER* 15 NAMEl 



IF (EXT.EQ.l) GOTO 111 



READ IN 
IF(N 
IF(N.EQ.2) 
IF(N.EQ.3) 
IF(N.EQ.4) 
IF(N.EQ.5) 
IF(N.EQ. 6) 
IF(N.EQ.7) 
IF(N.EQ. 8) 
IF(N.EQ.9) 
IF(N.EQ. 10) 
IF(N.EQ. 11) 
IF(N.EQ. 12) 
IF(N.EQ.13) 
IF(N.EQ.14) 
IF(N.EQ. 15) 



THE DEPTH AND 
EQ.l) NAMEl = 
NAMEl = 
NAMEl = 
NAMEl = 
NAMEl = 
NAMEl = 
NAMEl = 
NAMEl = 
NAMEl = 
NAMEl 



NAMEl 

NAMEl 

NAMEl 

NAMEl 

NAMEl 



IF(OP.EQ. 1)PRINT*, 



VELOCITY ARRAYS 
'/ON880512 DVT A’ 
'/ON880622 DVT A’ 
’/ON880721 DVT A’ 
’/ON880803 DVT A’ 
•/ON881027 DVT A’ 
•/ON890113 DVT A* 
•/ON890308 DVT A' 

’ /ON890322 DVT A’ 
’/ON890426 DVT A’ 

= ’/ONTESTO DVT A’ 

= ’/ONTEST2 DVT A’ 

= '/ONTEST4 DVT A* 

= '/ONTEST6 DVT A* 

= • /ONTEST8 DVT A ’ 

= ’/ONTEST83 DVT A’ 

FILE: 



’LOAD VELOCITY 
IF(OP.EQ.l)WRITE(91,») 'LOAD VELOCITY FILE 
IF(OP.EQ.l)WRITE(92,*) 'LOAD VELOCITY FILE 
OPEN ( UNIT=4 , FILE=NAME1 , STATUS= ' OLD ' ) 

1 = 1 
CONTINUE 



NAMEl 
• , NAMEl 
• , NAME 1 
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READ(4, 130,ERR=7,END=10)L(I) ,VEL(I) 

L(I) = -L(I) 

I = I + l 
GOTO 5 

7 WRITE (*,*)' I THERE WAS AN ERROR READING THE FILE !' 

STOP 

10 CONTINUE 

CLOSE (UNIT=4) 

M = I-l 

★ 

* FORM THE SET OF LAYER MIDPOINTS 

★ 

DO 40 1=1, M-1 

LM(I) = .5*(L(I) + L(I+1)) 

40 CONTINUE 

* 

* FORM DEPTH INCREMENTS, AND ALL SOUND VELOCITY SLOPES AND INTERCEPTS 

★ 

DO 50 1=1, M-2 

DZ(I) = LM(I+1) - LM(I) 

V0(I) = (LM(I+1)*VEL(I) - LM(I)*VEL(I+1) )/DZ(I) 

V1(I) = (VEL(I+1) - VEL(I) )/DZ(I) 

50 CONTINUE 

LM(M) = LM(M-l) + DZ(M-2) 

130 FORMAT(5X,D8.2, 5X,D7.2) 

111 IF(A2.LT.LM(M-1) .OR. EXT.EQ.2) GOTO 126 

C EXTRAPOLATE 

C THE SOUND VELOCITY PROFILE BY USING A QUADRATIC FUNCTION OVER 
C THE DEEPEST 100 FEET. 

C FIRST COUNT THE NUMBER OF LAYERS (OF THICKNESS DZ(M-2)) TO 
C BE ADJOINED. ALSO MUST EXTEND THE L ARRAY. 

KO = 2 + MAX(0,NINT( (A2-LM(M-1) )/DZ(M-2) ) ) 

C FIND AVERAGE DEPTH OF LAST 100 FEET. 

LB = O.ODO 
DO 43 I = M-21,M-1 
LB = LB + LM(I) 

43 CONTINUE 
LB = LB/21 

C FORM SUMS OF POWERS AND PRODUCTS. 

SV = O.ODO 
SVU2 = O.ODO 
SVU = O.ODO 
SU2 = O.ODO 
SU4 = O.ODO 
DO 45 I = M-21,M-1 
U = LM(I) - LB 
SV = SV + VEL(I) 

SVU = SVU + U*VEL(I) 

SVU2 = SVU2 + U**2 * VEL(I) 

SU2 = SU2 + U**2 
SU4 = SU4 + U»*4 
45 CONTINUE 

G = SVU/SU2 

GG = (21»SVU2 - SU2*SV) / (21»SU4 - SU2»»2) 
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Vl(M-l) = G 

C PERFORM THE EXTRAPOLATION. 

DO 125 I=M,M+KO 

Vl(I-l) = Vl(I-2) + GG*DZ(M-2) 

LM(I) = LM(I-l) + DZ(M-2) 

VEL(I) = VEL(I-l) + DZ(M-2)*V1(I-1) 

VO(I-l) = (LM(I)*VEL(I-1) - LM(I-1)»VEL(I) )/DZ(M-2) 
L(I+1) = L(I) + DZ(M-2) 

DZ(I-l) = DZ(M-2) 

125 CONTINUE 

C UPDATE M, THE NUMBER OF LAYERS 

M = M + KO 

126 CONTINUE 
RETURN 
END 
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APPENDIX H: REGIONAL POSLOC DATA (INTERIOR ARRAY 15) FOR RANGE 





REGIONAL 

SATELLITE 


POSLOC DATA INTERIOR ARRAY 15 
ARRAYS WITH ERRORS - ISOSPEED 

REGION 13 






ARRAY 15 SBL 


ARRAY 14 SBL 


ARRAY 24 SBL 


LONGBASE 


X 


49520.90 


49487.10 


49482.90 


49510.14 


Y 


-8605.20 


-8607.33 


-8590.08 


-8588.79 


Z 


425.14 


375.98 


424.18 


428.80 


THS 


0.20431 


0.21783 


0.20157 




THL 


0.20347 


0.20578 


0.20051 




PHS 


-2.59788 


-0.50234 


1.58702 




PHL 


-2.60237 


-0.49611 


1.58078 




HS 


4364.28 


4376.90 


4367.09 




HL 


4365.04 


4388.25 
REGION 14 


4368.03 






ARRAY 15 SBL 


ARRAY 5 SBL 


ARRAY 14 SBL 


LONGBASE 


X 


49390.02 


49412.46 


49407.20 


49401.91 


Y 


-4369.35 


-4360.42 


-4370.22 


-4360.26 


Z 


417.28 


386.64 


385.75 


387.20 


THS 


0.20704 


0.21490 


0.21855 




THL 


0.21397 


0.21477 


0.21821 




PHS 


2.66863 


-1.59600 


0.51579 




PHL 


2.66552 


-1.59845 


0.51840 




HS 


4342.51 


4317.04 


4318.03 




HL 


4336.08 


4317.16 
REGION 15 


4318.35 






ARRAY 15 SBL 


ARRAY 5 SBL 


ARRAY 6 SBL 


LONGBASE 


X 


53197.79 


53245.52 


53236.15 


53241.45 


Y 


-2059.94 


-2093.16 


-2091.73 


-2069.93 


Z 


389.46 


408.91 


411.46 


343.39 


THS 


0.21580 


0.21317 


0.21216 




THL 


0.22656 


0.22861 


0.22820 




PHS 


1.58433 


-0.50286 


-2.63156 




PHL 


1.57415 


-0.49851 


-2.63544 




HS 


4287.92 


4250.41 


4250.74 




HL 


4277.56 


4235.70 
REGION 21 


4235.51 






ARRAY 15 SBL 


ARRAY 6 SBL 


ARRAY 16 SBL 


LONGBASE 


X 


57039.28 


57062.13 


57062.38 


57071.57 


Y 


-4266.55 


-4325.19 


-4325.69 


-4319.17 


Z 


370.65 


412.73 


409.32 


385.99 


THS 


0.21850 


0.20903 


0.21008 




THL 


0.21495 


0.21524 


0.21547 




PHS 


0.50285 


-1.54383 


2.65266 




PHL 


0.48858 


-1.54160 


2.65032 




HS 


4317.97 


4310.26 


4330.69 




HL 


4321.34 


4304.50 
REGION 22 


4325.65 





CORRECTION 



GOAL 

49493,30 

-8593.79 

400.00 



GOAL 

49404.92 

-4356.84 

400.00 



GOAL 

53235.75 

-2085.69 

400.00 



GOAL 

57054.98 

-4330.68 

400.00 
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ARRAY 15 SBL 


ARRAY 16 SBL 


ARRAY 25 SBL 


LONGBASE 


GOAL 


X 


57081.17 


57057.44 


57056.64 


57053.99 


57054.15 


Y 


-8523.61 


-8582.94 


-8588.56 


-8586.27 


-8587.96 


Z 


379.08 


394.12 


404.19 


416.36 


400.00 


THS 


0.21267 


0.20893 


0.18296 






THL 


0.20421 


0.20391 


0.18021 






PHS 


-0.51722 


-2.61546 


1.55218 






PHL 


-0.53262 


-2.61520 


1.55279 






HS 


4401.01 


4426.93 


4416.72 






HL 


4408.89 


4431.59 


4418.96 










REGION 23 










ARRAY 15 SBL 


ARRAY 24 SBL 


ARRAY 25 SBL 


LONGBASE 


GOAL 


X 


53341.65 


53288.99 


53293.50 


53294.50 


53293.11 


Y 


-10680.56 


-10692.31 


-10704.16 


-10690.85 


-10707.34 


Z 


406.18 


425.32 


418.14 


452.52 


400.00 


THS 


0.20989 


0.20128 


0.18299 






THL 


0.19921 


0.19505 


0.17508 






PHS 


-1.55099 


0.54496 


2.58304 






PHL 


-1.56189 


0.54459 


2.58032 






HS 


4333.94 


4367.96 


4340.60 






HL 


4343.55 


4373.42 


4346.82 
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APPENDIX I: FORMULATION OF THE PROBLEM AS A NONLINEAR PROGRAM 
AND ALGORITHM CHOICE 

Using the objective function defined in Ch. Ill, the 
mathematical formulation for the array locational correction 
problem is stated as follows: 



INDICES: 

i coordinate index 

j triple overlap region index, j=l,...,NRi, 

k sensor array index 

GIVEN DATA: 

{X\,} initial position (x,y,z) for array k for i=l,2,3 
{A\j} initial orientation (xtilt,ytilt, zrot) for array 
k for i=l,2,3 

NR|j number of triple overlap regions for array k 
v(z) the DVP of the water as a function of depth 
t the transit times of the acoustic pings 

VARIABLES: 

Decision : 

SHIFTi, , = location shift (x, y , z , xtilt, ytilt, zrot) for 
array k for i=l,...,6 

Internal : 

{ZER|^j} = depth error (z) for array k in region j 
{HER^j} = horizontal range error for array k in region 

j 

{PHER,.j} = azimuth angle error for array k in region 

j 

{XS|^jj}= SBL posloc (x,y,z) from array k in region j 
for i=l,2,3, this is a function the arrays 
location (decision variables) , the DVP and 
transit time, evaluated through the ray 
tracing algorithms 

{XL^jj}= LBL posloc (x,y,z) from array k in region j 
for i=l,2,3, this is a similar function to the 
above, but uses three independent arrays 
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{HL^j} = horizontal range from array k to LBL posloc 
in region j 

{HS|jj} = horizontal range from array k to SBL posloc 
in region j 

{PHL^j} = azimuth angle from array k to LBL posloc in 
region j 

{PHSj,j} = azimuth angle from array k to SBL posloc in 
region j 



CONSTRAINTS: 






j 



/ 



XL 



k, j , 1 






for all k, j 



j + kslj_2 for all k,j 

f(v(z),t) = this function is used to construct the 
acoustic ray path 

= f] f(v(z),t)) 

for all k,j i=l,2,3 
(this function is evaluated using the iterative ray 
tracing algorithms [Ref. 1]) 



XL,j, = f 2 ((X,.,,A,,)j; f(v(z),t)) 

for all k,j i=l,2,3 

(this function is similar to the above (fj), but uses 
three independent arrays, for region j, in the posloc 
evaluation [Ref. 3]) 

HERt^j = - HS^j for all k,j 

ZER^j = XI^j 3 - XSj,j 3 for all k,j 

PHL,,j = arctan[(XL,,,3-X,,3)/(XL,..,-Xk,,) ] 

for all k,j i=l,2,3 



PHS,^ 


= arctan[(XS,^,2-X,.2)/(XS,j,, 


-Xm)] 

for 


all 


k/ j 


i— 1 ,2,3 


PHER,^ 


= PHL,^ - PHS,^. 


for 


all 


k, j 




Xk.. 


= X\, + SHIFTj,, 

= + SHIFT, ;(.,3, 


for 

for 


all 

all 


k, i= 
k, i= 


1,2,3 

1,2,3 
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-7i/2 i ^ ^ ii/2 for all k, i=l,2 



-n ^ ^ 71 for all k 

X^i within the RANGE coordinate system for all k, i=l,2,3 
Xk ,3 > 0 (array must be below water) for all k 



OBJECTIVE FUNCTION: 





MIN EE >JzERl_j + HERl^j + {HL„jXPHER^_j)^ 

k j=i 



for all k with NR^ = 6 

The first summation in the objective function is over the 
set of index k which yields the value NR|^ =6. This isolates 
the problem to the interior arrays only. 

Due to the nature of underwater ray tracing, the objective 
function and constraints are nonconvex and nonlinear. This 
environmental nature also prevents the analytical expression 
of the functions fj and fj (see the dynamic programming 
solution outlined in Ref 1) . Without the analytical 
expressions of these functions the gradients are also 
unavailable in analytical form. Based on the above, any 
algorithm requiring the evaluation of the gradient would be 
too time consuming requiring the evaluation of the functions 
to obtain the gradients. With this in mind, we choose an 
algorithm that does not require the evaluation of a gradient. 
Among the algorithms available without using a gradient are 
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the cyclic coordinate descent algorithms. These algorithms 
allow the problem structure to be more efficiently exploited. 

A simulated annealing algorithm was used to determine the 
(global) optimality of the solution provided by ERRFIX. This 
algorithm allowed alternate local solutions to the problem to 
be found. Based on computational experiments, solutions from 
simulated annealing were only marginally better than those 
obtained using ERRFIX. Thus it is hypothesized that ERRFIX 
provides a nearly global optimal solution. Letting ERRFIX 
perform more iterations may enhance the quality of the 
solution produced. 
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